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Abstract 


As  a  minimum,  in  the  design  of  control  systems,  the 
engineer  wants  the  controlled  system  to  exhibit  certain 
acceptable  response  characteristics  which  approach  an  ideal. 
Specifying  the  closed-loop  response  of  a  system,  including 
both  the  modes  and  mode  shapes,  can  be  accomplished  with  the 
eigenstructure  assignment  approach  to  system  synthesis. 

This  effort  was  to  create  an  interactive  computer-aided 
control  system  design  program  to  enable  the  designer  to  use 
the  modern  control  approach  to  design  a  control  system  with 
specified  response  characteristics,  or  to  come  as  close  to 
the  ideal  as  possible.  With  this  eigenstructure  assignment 
program,  the  design  engineer  can  easily  calculate  the  feed¬ 
back  gains  needed  to  give  the  controlled  system  the  optimum 
response  characteristics  by  specifying  the  desired  eigen¬ 
values  and  eigenvectors. 

Given  a  linear,  time-invariant  state-space  model  of  a 
controlled  system  with  a  system  matrix  A  and  an  input  distri 
bution  matrix  B,the  program  MODES  uses  the  singular  value 
decomposition  to  find  the  range  space  of  achievable  eigen¬ 
vectors  of  the  augmented  matrix  tA  -  A  I,  B1 .  Here,\L  is  a 
desired  eigenvalue.  The  singular  value  decomposition  is 
used  again  to  project  the  desired  eigenvector  pdL  into  the 
range  space  of  achievable  eigenvectors.  This  projection 
yields  the  eigenvector  which  comes  as  close  to  matching  the 
desired  eigenvector  as  is  possible.  This  projection  is 
termed  the  optimal  eigenvector,  p  ,  associated  with  the 
desired  eigenvalue  .  The  optimal  eigenvectors  are  col¬ 
lected  into  a  matrix  of  eigenvectors,  P  .  Because  of  the 


form  of  the  augmented  matrix  [A  -  VI,  B]  ,  when  we  find 
the  matrix  of  optimal  eigenvectors,  we  also  can  find  the 
matrix  product  GPq  where  G  is  the  feedback  gain  matrix 
required  to  give  the  controlled  system  the  optimal  eigen- 
structure.  To  solve  for  the  feedback  gain  matrix  G,  we  only 
have  to  postmultiply  the  postmultiply  the  product  GPq  by  the 

inverse  of  P  ,  P"1. 

The  program  MODES  performs  these  calculations.  In 
addition,  MODES  can  provide  valuable  information  about  the 
controlled  system  to  assist  the  designer  in  specifying  the 
desired  eigenstructure.  By  calculating  the  eigenvalues  and 
eigenvectors  of  the  original  system,  by  plotting  the  time 
response  history  of  the  original  system,  and  by  calculating 
the  resolvent  matrix,  poles  and  zeroes  for  classical  control 
analysis,  MODES  is  a  strong  tool  in  determining  how  the 
eigenstructure  should  be  altered.  By  presenting  the  same 
information  for  the  modified  “optimized"  system,  MODES  can 
show  where  additional  changes  to  the  specified  desired 
eigenstructure  should  be  made. 

The  accuracy  of  MODES  is  verified  with  sample  applica¬ 
tions  found  in  the  technical  literature. 


MULTI-INPUT/MULTI-OUTPUT  DESIGNATED  EIGENSTRUCTURE  (MODES): 
A  COMPUTER-AIDED  CONTROL  SYSTEM  DESIGN  PROGRAM 


I .  Introduction 

With  the  wide  variety  of  computer  resources  available 
in  industry  today,  ranging  from  the  desk  top  micro-computer 
to  the  "super  computer",  the  control  system  design  engineer 
is  no  longer  constrained  to  perform  the  many  required  design 
algorithms  by  hand.  Nor  is  he  required  to  write  and  test 
new  computer  algorithms  for  each  new  set  of  design  con¬ 
straints.  Today,  there  is  a  growing  number  of  sophisticated 
computer-aided  control  system  design  (CACSD>  packages  for 
control  system  development.  CACSD  technology  has  greatly 
enhanced  productivity  and  will  continue  to  do  so  as  more 
powerful  packages  become  available,  and  as  new  design 
routines  are  added  to  existing  CACSD  systems  to  give  them 
greater  versatility  (Spang,  1984:  1724). 

One  control  system  design  tool  available  to  the 
engineer,  but  not  explicitly  found  in  most  CACSD  systems, 
is  the  state-space  approach  for  system  synthesis  by  state 
variable  feedback  known  as  eigenstructure  assignment.  For 
the  linear  time-invariant  model 

x(t)  =  Ax(t)  +  BuCt) 

a  suitable  algorithm  can  be  written  which  will  generate  the 
feedback  gain  matrix  which  most  closely  places  the  eigen¬ 
values  and  eigenvectors  of  the  controlled  system  to  their 
desired  design  values.  Such  an  algorithm  is  the  subject  of 
this  thesis. 


As  stated  by  Walker,  Shah,  and  Gupta  (Walker,  et  al, 
1984:  1744>,  one  of  the  goals  for  computer-aided  engineering 
is  to  accelerate  and  encourage  generation  of  new  ideas  and 
approaches  for  computer  packages.  The  design  program 
"Multi-Input,  Multi-Output  Designated  Eigenstructure" 

(MODES)  is  an  approach  which  could  easily  be  integrated  into 
existing  comprehensive,  flexible  CACSD  packages,  or  can 
stand  alone  as  a  single-purpose  design  program  to  be  used  by 
the  design  engineer  in  conjunction  with  other  programs.  As 
a  stand-alone  program,  MODES  may  be  most  useful  in  the 
classroom  environment  as  an  aid  in  the  instruction  of  the 
eigenstructure  approach  to  control  system  design. 

Overview  of  MODES. 

MODES  is  an  interactive  program  designed  for  the  first 
time  user  as  well  as  the  user  who  has  become  very  familiar 
with  its  features.  The  first  message  to  appear  asks  the 
user  if  he  wants  a  file  of  the  program  output  saved  as  a 
computer  file.  The  second  message  asks  if  an  introductory 
message  is  desired.  Next,  the  user  is  asked  if  he  wants 
full  output  including  intermediate  results,  or  if  he  wants 
only  the  information  of  major  interest. 

The  first  information  to  be  entered  about  the  specific 
problem  to  be  worked  by  MODES  are  the  matrices  A  and  B 
describing  the  original  system.  These  matrices  may  be 
entered  from  the  keyboard,  or  read  from  existing  computer 
files.  Whether  the  matrices  are  entered  from  the  keyboard 
or  read  from  an  existing  computer  file,  the  user  is  allowed 
to  edit  the  matrices  and  to  save  them  as  new  computer 
files.  Then  MODES  asks  if  the  user  wants  to  see  the 
eigenstructure  of  the  basic  system.  If  the  user  wants, 

MODES  will  then  perform  a  discrete  time  simulation  of  the 


basic  system  of  equations,  assuming  zero  intial  conditions, 
and  plot  the  time  response  characteristics  on  the  terminal 
screen.  MODES  then  offers  to  print  the  resolvent  matrix, 
poles  and  zeroes  of  the  system.  This  is  the  point  at  which 
the  user  is  prompted  to  enter  the  desired  eigenvalues  and 
eigenvectors.  As  with  the  system  matrices,  the  desired 
eigenstructure  can  be  entered  from  the  keyboard  or  read  from 
an  existing  computer  file.  Also,  the  user  may  edit  the 
eigenstructure  matrices  whether  they  were  entered  from  the 
keyboard  or  read  from  an  existing  computer  file.  The  eigen¬ 
structure  matrices  may  be  saved  for  future  use.  Because 
complex  eigenvalues  must  appear  with  their  complex  conju¬ 
gate,  when  the  user  enters  the  eigenstructure  from  the 
keyboard,  MODES  will  automatically  enter  the  conjugate  to 
every  complex  number. 

At  this  time,  MODES  performs  a  singular  value  decom¬ 
position  on  the  system,  as  described  in  chapter  II,  to  find 
the  feedback  gain  matrix  G  which  most  closely  alters  the 
system  eigenstructure  to  that  specified  by  the  user.  After 
displaying  this  feedback  gain  matrix,  MODES  defines  the 
matrix  X  such  that 

X  =  C  A  +  BG)  =  PAP- 1 

where  the  columns  of  P  are  the  achievable  eigenvectors,  and 
A  represents  the  diagonal  matrix  of  desired  eigenvalues  Csee 
chapter  II  for  more  details).  The  user  has  the  option  of 
saving  both  the  feedback  gain  matrix  and  the  final  modified 
X  matrix.  Next,  MODES  offers  to  print  the  actual  eigen¬ 
structure  of  the  final  modified  system  as  well  as  the 
original  system  for  convenient  comparisons. 

Now  MODES  asks  if  the  user  wants  a  discrete  time 


simulation  of  the  modified  system  plotted  on  the  terminal 
screen.  Finally,  MODES  offers  to  calculate  the  resolvent 
matrix  and  the  poles  and  zeroes  of  the  modified  X  matrix. 
This  information  can  be  useful  when  examining  the  system 
using  frequency  domain  techniques. 

Hardware  Used  for  Thesis  Development. 


This  thesis  was  developed  with  the  computer  resources 
of  the  Air  Force  Institute  of  Technology  (AFIT)  as  well  as 
my  own  equipment.  The  primary  computer  resource  used  was 
the  AFIT  VAX/VMS  Classroom  Support  Computer  (CSC)  with  its 
resident  Fortran  compiler.  My  personal  equipment  consists 
of  an  Epson  Equity  I  computer  (IBM  PC  compatible)  with  a 
Hayes-compatible  modem  and  Panasonic  KX-P1091  printer.  In 
addition  to  running  on  the  VAX/VMS,  MODES  has  been  compiled 
for  both  the  IBM  PC  compatible  computers  as  well  as  the 
Atari  520ST  home  computer.  For  the  IBM  PCs,  version  3.2  of 
the  Microsoft  F0RTRAN77  compiler  was  used;  For  the  Atari 
520ST,  the  Pro  Fortran-77  compiler  by  Prospero  Software  was 
used.  For  both  of  these  home  computer  compilers,  the 
maximum  size  of  the  system's  A  matrix  was  reduced  from  15  by 
15  to  10  by  10.  Even  so,  the  IBM  PC  executible  program 
exceeds  220,000  bytes  in  size,  and  cannot  run  on  a  machine 
with  256K  RAM  or  less.  To  date,  the  PC  version  of  MODES  has 
run  on  the  Zenith  Z-150,  Z-241  and  Z-248  computers,  as  well 
as  the  Columbia  and  Victor  computers.  Because  of  its 
excellent  error  messages,  I  used  the  VATF0R-77  Fortran 
interpreter  by  VATCOM  Systems,  Inc.  Although  memory 
limitations  does  not  allow  the  VATCOM  interpreter  to  run  the 
complete  MODES  program,  I  was  able  to  make  great  use  of  the 
interpreter  when  conducting  the  "bottom-up"  testing  of  each 
module. 


Summary. 

MODES  is  an  interactive  computer-aided  design  program 
ideally  suited  for  classroom  instruction  of  the  eigen- 
structure  assignment  approach  to  control  system  design.  By 
showing  the  designer  the  eigenstructure  of  the  equations 
describing  the  basic  system  and  plotting  the  time  response 
of  that  system  and  calculating  the  system  poles  and  zeroes, 
MODES  enables  the  designer  to  see  better  how  the  eigen- 
structure  should  be  modified  to  give  it  the  desired 
characteristics.  Once  MODES  has  determined  the  optimal 
feedback  gain  matrix,  the  closed-loop  eigenstructure,  the 
closed-loop  time  response  characteristics  and  the 
closed-loop  poles  and  zeroes  are  plotted  on  the  screen. 

With  the  modular  approach  taken  during  the  development 
of  MODES,  one  should  have  little  difficulty  in  appending  it 
to  an  existing  package  of  other  control  system  design 
programs,  or  modifying  it  to  meet  new  needs. 
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Thesis  Overview. 

The  remainder  of  this  thesis  is  divided  into  five 
sections.  Chapters  II  through  VI,  along  with  two  appendices. 

Chapter  II  discusses  the  theory  of  the  eigenstructure 
assignment  approach  to  control  system  design.  The  theory  of 
singular  value  decomposition  is  presented,  as  well  as  its 
application  in  MODES.  All  essential  steps  in  the  eigen¬ 
structure  assignment  problem  are  presented. 

Chapter  III  presents  two  sample  cases  of  this  design 
approach  found  in  the  technical  literature,  and  uses  them  to 
verify  the  correctness  of  the  MODES  coding.  The  first  case 
is  based  on  the  AFTI/F-16  demonstrator  aircraft’s  pitch¬ 
pointing  features.  The  second  case  is  a  look  at  a  flight- 
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test  maneuver  autopilot  for  the  F-15  fighter  aircraft. 

Chapter  IV  presents  a  discussion  of  the  major  sub¬ 
routines  found  in  MODES.  The  subroutines  for  performing  the 
singular  value  decomposition,  setting  up  the  matrices  for 


input  to  the  singular  value  decomposition  routine,  cal¬ 
culating  the  eigenstructure  of  a  general  matrix,  defining 
and  printing  the  eigenstructure,  calculating 
the  modified  system  matrix,  discretizing  the  system 
response,  plotting  the  system  response,  finding  the  resol¬ 
vent  matrix  and  the  poles  and  zeroes  of  the  resolvent 
matrix,  calculating  the  inverse  of  a  square  matrix  and 
performing  common  utilities  are  presented. 

Chapter  V  is  the  users'  guide  for  MODES.  The  conclu¬ 
sions  are  found  in  Chapter  VI.  The  appendices  contain  the 
coding  for  MODES.  Appendix  A  lists  the  main  program,  and 
Appendix  B  lists  all  of  the  subroutines. 


II.  Approach  to  Eigenstructure  Assignment 
CElbert,  1984:  148-174) 

The  general  linear  system  is  described  by  the  state 
equation: 

xCt)  «  AC t)xC t)  +  BC  t)uC t) 

For  the  open-loop  control  system,  the  designer  must  find  a 
control  function  uCt)  for  the  time  interval  of  interest  such 
that  the  state  vector  xCt)  varies  in  a  desired  manner.  The 
control  function  is  dependent  on  time  only.  For  the  closed- 
loop  control  system,  the  control  function  is  dependent  on 
the  states  and  perhaps  on  time.  Therefore,  for  the  closed- 
loop  system,  the  state  equation  can  be  written  as 

xCt)  *  ACt)xCt)  +  BCt)uCxCt) , t) 

If  we  assume  a  linear  controller,  the  control  function  can 
be  expressed  as 

uCxCt),t)  =  GCt)xCt) 

where  GCt)  is  the  feedback  gain  matrix. 

Substituting  this  into  the  closed-loop  state  equation 

gives 

xCt)  =  ACt)xC t)  +  BC t)GCt)xC t) 

=  CACt)  +  BCt)GCt> IxCt) 

When  ACt),  BCt)  and  GCt)  are  not  time  dependent,  we  can 


write  our  state  equations  as 


xCt)  =  [A  +  BG]xCt> 


For  notational  convenience,  denote 


X  ®  A  +  BG 


This  gives 


xCt)  =  XxCt) 


C2.  i> 


Therefore,  the  response  characteristics  of  the  linear, 
time-invariant,  closed-loop  state  variable  feedback  control 
system  are  determined  by  the  eigenstructure  of  the  matrix  X. 
The  design  synthesis  implemented  by  MODES  consists  of  calcu¬ 
lating  the  feedback  gain  matrix  G  such  that  the  eigenstruc- 
ture  of  the  X  matrix  produces  the  desired  system  response 
characteristics. 

When  specifying  the  eigenstructure  of  the  X  matrix,  and 
therefore  the  response  characteristics  of  the  controlled 
system,  the  diagonalizing  matrix  of  eigenvectors,  P,  and  the 
diagonal  matrix  of  eigenvalues.  A,  are  defined.  Here,  the 
columns  of  P  are  the  eigenvectors  of  X,  and  A  is  given  as 


where  is  the  eigenvalue  associated  with  the  eigenvector 
found  in  the  first  column  of  P,  \2  is  the  eigenvalue  associ¬ 
ated  with  the  eigenvector  found  in  the  second  column  of  P, 


and  so  on.  This  fives 


X  =  PAP' 


(2.  2) 


For  the  special  case  when  the  input  distribution  matrix 
B  has  the  same  dimensions  as  A,  and  B  is  non-singular ,  we 
can  find  a  unique  feedback  gain  matrix  G  as  follows. 
Combining  Eqs  (2.1)  and  (2.2)  yields 


BG  -  X  -  A 


PAP  -  A 


which  gives 


G  =  B"1CPAP"i  -  Al 


Because  practical  systems  do  not  often  occur  such  that  the 
number  of  inputs  equals  the  number  of  states,  this  expres¬ 
sion  is  of  limited  use.  In  most  cases,  the  input  distri¬ 
bution  matrix  B  is  not  square,  which  leaves  either  no 
solutions  for  G,  a  single  unique  solution,  or  many 
solutions.  We  must  now  explore  if  one  or  more  solutions 
exist. 

Since  the  columns  of  P  from  Eq  (2.2)  are  the  eigen¬ 
vectors  p^  associated  with  eigenvalue  and  Xt  must 

satisfy  the  defining  relation  for  an  eigenvector 


Xp  =  X  p 

*L  L  I 


Substituting  Eq  (2.1)  gives 


CA  +  BG)p  ■  \  p  =  A  Ip 

L  L  V  X.  L 

where  I  is  the  identity  matrix.  This  gives 


Ap^  +  BGp^  -  Ip^  =  0 

or 

CA  -  A  lip  ♦  BGp  ■  0 

L  L  r  t 

Because  p^  is  a  column  vector,  the  product  Gp^  is  also 
a  column  vector.  This  allows  us  to  partition  this 
expression  as 


Ve  now  have  an  expression  which  establishes  the  possible 
values  of  the  eigenvector  as  well  as  the  feedback  gain 
matrix  G  relative  to  an  eigenvalue  A^ . 

When  A  is  dimensioned  n  by  n  and  B  is  n  by  m,  the 
number  of  inputs  available  is  m.  This  means  that  the  (n+m) 
dimensioned  vector 


(2 .  3> 


must  lie  in  the  null  space  of  the  n  by  (n+m)  matrix: 


CA  -  A  I  ,  BJ 

t 


<2.  4> 


Therefore,  we  must  find  the  null  space  of  the  augmented 


matrix  in  expression  <2.4),  and  then  select  the  optimal 
vector  in  the  form  of  expression  <2. 3)  from  that  null  space 
which  elves  a  mode  shape  for  the  mode  corresponding  to  the 
eigenvalue  which  comes  as  close  to  matching  the  desired 
mode  shape  as  is  possible.  This  optimal  vector  is  found  by 
projecting  the  desired  eigenvector  into  the  first  n  rows  of 
the  null  space  of  expression  <2. 4).  As  will  be  shown  in  the 
last  section  of  this  chapter,  the  null  space  of  a  matrix  can 
be  found  by  performing  the  singular  value  decomposition  of 
the  matrix.  The  dimensions  of  the  null  space  matrix  for  the 
matrix  in  expression  <2. 4)  are  <n+m)  by  <n+m-r),  where  r  is 
the  rank  of  expression  (2.4).  Ve  repeat  this  procedure  for 
each  eigenvalue  and  eigenvector  p^ .  From  the  lower 
partitions  of  the  n  optimal  vectors  of  the  form  in 
expression  (2.3),  we  form  the  m  by  n  matrix  R  such  that 

R  *  [Gp  ,  Gp  ,  ...  ,  Gp  ] 

ol  02  *or> 

where  the  subscript  o  refers  to  the  optimal  eigenvector. 

This  is  equivalent  to 

R  -  GP 

O 

Since  the  diagonalizing  matrix  of  eigenvectors  Pq  is 
nonsingular,  we  can  easily  solve  for  the  required  feedback 
gain  matrix  G, 

G  -  RP"1  (2.5) 

O 

Therefore,  once  a  permissable  set  of  eigenvectors  is 
specified,  we  have  a  unique  feedback  gain  matrix,  G.  The 
only  limitation  for  this  procedure  is  that  the  calculated 


optimal  eigenvectors  must  be  linearly  independent  so  that  P 
is  nonsingular,  and  therefore  invertible. 


Selection  of  Optimal  Eigenvectors  from  a  Subspace. 


Because  the  control  designer  has  specified  a  particular 
eigenstructure,  and  wants  the  controlled  system's  eigen- 


structure  to  be  as  close  to  the  desired  eigenstructure  as 
possible,  some  method  must  be  used  to  select  the  "best" 


or  optimal  eigenvector  from  the  null  space  of  the  matrix 


given  in  expression  (2.4).  In  other  words,  the  null  space 


of  expression  (2.4)  defines  the  range  space  of  achievable 
system  eigenvectors.  From  this  range  space,  the  eigenvector 


which  most  nearly  matches  the  desired  eigenvector  (that  is. 


the  optimal  eigenvector)  must  be  found.  This  is  accom¬ 


plished  by  projecting  the  desired  eigenvector  into  the 


range  space  of  achievable  eigenvectors. 

Using  only  the  first  n  rows  (n  equals  the  dimension  of 
the  system’s  eigenvectors)  of  the  (n+m)  by  (n+m-r)  null 


space  matrix  for  expression  (2.4),  we  first  must  find  the 
coefficient  vector  q  which,  when  premultiplied  by  the 


first  n  rows  of  the  null  space  matrix,  yields  the  optimal 


eigenvector.  Note  that  the  first  n  rows  of  the  null  space 
matrix  for  expression  (2.4)  defines  the  range  space  of  the 


achievable  eigenvectors  as  found  in  the  upper  partition  of 
expression  (2.3).  Denoting  the  desired  eigenvector  and  the 


optimal  eigenvector  associated  with  the  eigenvalue  X  of 


expression  (2.4)  as  pdi  and  Pot ,  respectively,  and  denoting 


the  first  n  rows  of  the  null  space  of  expression  (2.4)  as 


[p  ],  our  task  is  to  find  the  coefficient  vector  q  such  that 


p ,  ip.  *  [p  ]q 

rdl  CM. 


A-.AV.  A  A  A  A  -V  «  ./  v« 

'v.r  vV  v  v .V.-vaV.  /?«•  .v.  Vc' 


The  symbol  m  Indicates  the  quantities  are  nearly  equal,  or 
as  close  to  being  equal  as  possible. If  we  can  find  the 
matrix  which,  when  multiplied  by  Cp^],  gives  us  the  identity 
matrix,  or  a  form  of  it,  we  can  solve  for  q .  Calling  such  a 
matrix  the  pseudoinverse  of  Cp^i,  and  using  the  notation 
Cp^]*  to  represent  this  pseudoinverse,  we  get 

Cp  ]  +p  ..  is  Cp  ] +p  =  £p  ]  +  tp  ]q  =  q 

v  di  t  oi  t  t 

Ideally,  jpo^  equals  pd  .  With  this  in  mind,  we  will  use 

q  *»  Cpt]+pdi  as  the  defining  relation  for  q.  This  leaves 

Poi  38  [p^  3 tp^  3  +Pdt  (Strang,  1976:  132).  Because  Cp^l  is 

dimensioned  n  by  (n+«-r),  Cp  ]  +  is  dimensioned  (n+n-r)  by  n. 
Also,  because  pdi  and  pV  both  are  dimensioned  n  by  1 ,  this 
leaves  q  to  be  dimensioned  (n+m-r)  by  1 .  Ve  can  see  that  q 
is  that  vector  which  projects  the  desired  eigenvector  onto 
the  column  space  of  the  first  n  rows  of  the  null  space  of 
expression  (2.4);  q  finds  the  optimal  eigenvector  which  most 
clearly  matches  the  desired  eigenvector.  Because  q  projects 
pdi  into  the  range  space  defined  by  Cp^],  it  can  also  be 
used  to  find  the  entire  vector 


This  is  the  optimal  vector  in  the  form  of  expression  (2.3) 
which  most  nearly  matches  p^  to  the  desired  eigenvector  pd^ . 
The  next  section  will  show  how  to  find  the  pseudoinverse  of 
a  matrix. 


Singular  Value  Decomposition. 

An  important  tool  of  numerical  linear  algebra  is  the 
singular  value  decomposition  CSVD)  CKlema  and  Laub,  1980: 
166).  As  alluded  to  earlier,  with  the  SVD,  one  can 
ascertain  several  important  characteristics  of  linear 
systems.  Important  for  our  applications  are  the  ability  to 
find  the  null  space  and  pseudoinverse  of  a  matrix. 

For  any  n  by  m  matrix  A  with  rank  r,  the  SVD  theorem 
states  that  A  can  be  decomposed  such  that 

A  *  UIVT  C2. 6) 

where  U  is  an  n  by  n  orthogonal  matrix,  V  is  an  m  by  m 
orthogonal  matrix,  and 


Here,  S  ■  diagCo^  a2,...,a)  with  2:0 

The  proof  of  the  SVD  theorem  CKlema  and  Laub,  1980: 
166-167)  is  as  follows.  Because  the  matrix  product  of  AT 
and  A  gives  a  positive  semi-definite  matrix  CStrang,  1976: 
244),  that  is  ATA  £  0  ,  then  all  of  the  eigenvalues  of  ATA 

are  greater  than  or  equal  to  zero  CStrang,  1976:  244).  In 
other  words,  the  spectrum  of  ATA  Cdimensioned  m  by  m)  is 
within  the  range  of  zero  to  +<*>.  Ve  will  denote  this 
positive  spectrum  by  Co*,  i  -  1,  2,...,  m>  and  call  this 
set  the  singular  values  of  ATA.  Here,  each  is  the 
positive  square  root  of  the  eigenvalue  Xt  of  ATA.  Ordering 
the  singular  values  such  that  a  >a  £...£o  >0*o  -...-o 

we  can  introduce  a  corresponding  set  of  orthogonal  eigen- 


vectors  v  .  Ve  know  that  A  A  has  orthogonal  eigen- 

1  m 

T 

vectors  because  A  A  is  symmetric,  and  every  symmetric  matrix 
has  an  orthogonal  set  of  eigenvectors  (Strang,  1976: 
135-136).  If  we  group  these  orthogonal  eigenvectors  into 
two  matrices 


V  ■  tv  v  ] 

V,  -  tv  , . . . , v  ] 

2  r  ♦  1  m 


and  define  S  ■  diag(oi . o)  ,  then  we  can  extend  the 

defining  relation  for  an  eigenvector  so  that  we  can  write 


ATAVt  -  V1S2  (2.7) 

Recalling  that  the  product  of  an  orthogonal  matrix  and  its 
transpose  yields  the  identity  matrix  (Strang,  1976:  120), 
and  because  Vt  is  orthogonal,  we  can  write  vyATAVi»  S2 
Premultiplying  and  postmultiplying  both  sides  of  this 
expression  by  S_1  yields 


S“1VjATAV1S  1  »  I  (2.8) 

Because  the  columns  of  the  orthogonal  matrix  V2  are  the 

eigenvectors  corresponding  to  the  zero-valued  eigenvalues  of 
T 

A  A,  we  can  again  extend  the  defining  relation  for  an  eigen¬ 
vector  as  we  did  in  Eq  (2.7)  and  get 


AtAV„  -  V„(0) 
2  2 


Again,  recognizing  the  properties  of  orthogonal  matrices,  we 


v;a‘ av„  =  o 
2  2 

which  gives 

AV_  -  0  <2.  9> 

2 

Here  we  can  see  that  V2  defines  the  null  space  of  A.  Now 
introduce  the  matrix  Ut  such  that 

U±  ■  AVtS” 1  C2.10) 

From  Eq  (2.8)  we  have  uyUi=  I  If  we  choose  any  matrix 

U2  such  that  U  *  <Ut,  U2)  is  orthogonal,  and  because  the 
matrices  V  and  V2  can  be  considered  to  define  the  orthog¬ 
onal  matrix  V  ■  C Vri ,  Vs>  ,  then  we  can  find  the  matrix 
product  UtAV.  Since 


UT  - 

we  have 


utav 


°!AVi 


UIAVi 


utav 
1  2 


uTav 
2  2 


(2.11) 


From  Eq  (2.10)  we  have  AVa  ■  l^S  This  gives 


ujAV^  U^UjS 


(2.12) 


.  "V 

jUm 

7S  ' 

▼*r» 


From  Eq  (2.9),  we  jet 


U  ‘  AV  -  0 
1  2 


(2. 13) 


and 


uIav 
2  2 


(2. 14) 


Also,  AV4  -  US  ,  so  that 


u‘av  -  u*  u  s  *  o 
2  1  2  1 


(2. 15) 


lie 


Combining  Eqs  (2.11)  through  (2.15)  yields 


UtAV 


r  s  o  - 
[  0  0  . 


(2. 16) 


Premultiplying  both  sides  of  Eq  (2.16)  by  U,  and  post- 
multiplying  both  sides  by  VT  gives 


A  -  UZV1 


(2.  6) 


as  desired. 

Again,  the  numbers  o1,...,or  along  with  °r*1"  0, . . . , 
onm  0  are  called  the  singular  values  of  A.  The  singular 
values  are  the  positive  square  roots  of  the  eigenvalues  of 


i.hL^ 

'JN 


ins 
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the  matrix  product  A  A.  The  columns  o f  U  are  known  as  the 
left  singular  vectors  of  A,  and  are  the  orthonormal  eigen¬ 
vectors  of  AAt.  Similarly,  the  columns  of  V  are  called  the 
right  singular  vectors  of  A,  and  are  the  orthonormal  eigen¬ 
vectors  of  AtA  (Klema  and  Laub,  1980:  167). 

To  see  in  more  detail  how  SVD  can  be  used  to  find  the 
null  space  of  a  matrix  (Reid,  1983:  452-453),  partition 
Eq  (2.6)  as  follows. 


T1 

L  0  0  J  L  vl  J 


(2.17) 


With  the  singular  values  in  the  submatrix  S  in  decreasing 
order  of  magnitude,  and  with  the  number  of  non-zero  elements 
of  S  equal  to  the  rank  of  A,  this  partition  is  such  that  Ut 
has  r  orthogonal  columns  u  ,  u  , up ,  and  U2  has  (n-r) 
orthogonal  columns  u  ^  u  .  Also,  the  orthogonal 

matrix  V  has  been  partitioned  such  that  V±  has  r  orthogonal 
columns  vt,  v2, . . . ,  v ,  and  V2  has  (m— r)  orthogonal  columns 

v  i4,...,  v  . 
r  + 1  '  m 

Because  the  product  of  any  orthogonal  matrix  with  its 
transpose  yields  the  identity  matrix,  we  can  postmultiply 
both  sides  of  Eq  (2.17)  by  V  and  get 


tUl  ' 


S  0 
0  0 


tu4s  ,  0] 


AtVl  '  V  “  tAVl  »  AV23  “  tU!S'0] 


Because  the  n  by  r  submatrix  AVt  equals  the  n  by  r  submatrix 
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:s\ 


U4S,  this  leaves  the  n  by  <m-r)  submatrix  AV2  equal  to  the 
zero  Matrix.  Therefore  the  (n-r)  orthogonal  colunns  of 
form  an  orthogonal  basis  for  the  m  by  <m-r)  dimensioned  null 
space  of  A. 

As  was  shown  in  the  second  section  of  this  chapter,  the 
projection  p  of  a  vector  E  onto  the  column  space  of  a  Matrix 
A  is  p  =  AA  E  CStrang,  1976:  132).  Here,  A*  is  the 
pseudoinverse  of  A.  With  A  »  UIVT  ,  we  find  the  pseudo¬ 
inverse  by  finding  that  Matrix  which,  when  Multiplied  by  A, 
gives  the  identity  Matrix  in  the  first  r  rows  and  colusns, 
and  zeroes  in  the  remaining  rows  and  columns  of  the  result¬ 
ing  matrix.  Here,  r  equals  the  rank  of  the  A  matrix.  By 
using  the  characteristics  of  orthogonal  matrices,  it  is 
simple  to  see  that  if  we  define 


diag  (1  /ox..  .  .  ,  l/or) 
0 


0 

0 


then 


(2. 18) 


where  I  is  dimensioned  r  by  r,  and  the  entire  Matrix  is  m  by 
m.  Since  A  ■  UZVT  ,  the  left  side  of  Eq  C2.18)  can  be 
written  as  VZ*UTA.  From  this,  it  is  apparent  that  VZ*UT  is 
that  matrix  we  are  looking  for.  That  is,  the  pseudoinverse 
is  given  as 

A*  -  VX*UT 

Therefore,  the  projection  p  of  a  vector  fj  onto  the  column 
space  of  the  Matrix  A  is 
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III.  Verifying  MODES  -  Two  Check  Cases 


AFTI^F-16. 

Sobel  and  Shapiro  present  an  application  of  the 
eigenstructure  assignment  method  to  decouple  the  pitch 
attitude  and  flight  path  angle  for  the  AFTI/F-16  aircraft 
CSobel  and  Shapiro,  1985:  181-187). 

Examining  the  equation  x  =  Ax  +  Bu,  with  the  state 
vector  x  and  control  u  defined  as 


r 


e 


the  A  and  B  matrices  are 


'  0 

0.  00665 

1.3411  ‘ 

0.16897 

0.25183  ' 

A  = 

0 

-0.86939 

43.223 

B  = 

-17. 251 

-1 . 5766 

0 

0. 99335 

— 1 . 34! 1 

-0.16897 

-0.25183 

Here,  the  control  inputs  and  <5f  are  the  elevator  and  flap 
deflections,  respectively;  y  is  the  flight  path;  q  is  the 
pitch  rate;  and  0  is  the  pitch  angle.  In  agreement  with 
Sobel  and  Shapiro,  MODES  gives  the  eigenvalues  of  this 
system  to  be  0.0,  5.452,  and  -7.662.  Sobel  and  Shapiro's 
objective  is  to  decouple  the  flight  path  and  pitch  modes  to 
produce  closed-loop  eigenvalues 


X  -  -5.6  ±  4. 2i  X,  -  -1.0 

s  p  3 


where  the  desired  closed-loop  eigenvectors  for  the  short 


period  mode  are  given  by 


0  ±  Oi 


i  ±  Xi 


X  ±  ii 


and  the  desired  closed-loop  flight  path  mode  eigenvector  is 
given  as 


The  X’s  in  the  short  period  eigenvectors  represent 
arbitrary  values.  Because  MODES  is  designed  for  the  user  to 
completely  specify  the  eigenstructure,  we  will  use  the 
actual  values  found  by  Shapiro  and  Sobel  for  these  two 
eigenvector  components.  Now,  with  the  short  period  mode 
eigenvector  given  as 


1  T  9. 5i 
-0.9286  ±  ii 


we  can  verify  that  MODES  finds  the  correct  feedback  gain 
matrix  0  and  the  correct  matrix  X,  where 
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X  -  A  ♦  BO 


(2.1) 


When  this  problem  was  solved  using  the  IMSL  computer 
library,  the  feedback  gain  matrix  G  and  the  closed-loop 
system  matrix  X  satisfying  the  equation 


x  ■  Xx 


(3.1) 


are  given  as 


.  2147 


0.6405 


6.2141 


4568  -0 . 4561  -9 . 4948 


■  -1.0 

0.0 

o 

» 

o 

-29.6 

-11.2 

-49.0 

1.0 

1.0 

0.0 

Rounding  off  to  the  same  number  of  significant  figures, 
MODES  calculates  these  matrices  to  be 


2145  0.6405  6.2136 
4567  -0.4562  -9.4943 


'  -1.0  0.0  0.0 

-29.6  —11.2  -49.0 


This  is  in  excellent  agreement,  showing  MODES  does  in 
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■»  "> 


fact  generate  the  proper  gains. 


F-15. 

The  second  case  used  to  verify  the  progras  NODES 
involves  the  flight  control  systen  for  a  flight-test 
Maneuver  autopilot  (Alag  and  Duke,  1986:  441-445). 
Considering  only  the  lateral  Modes,  we  have  the  A  Matrix 
given  as 


A  - 


’  -0.2337 

0.0358 

-0.9994 

0.0387 

-40.0103 

-2.1420 

1 . 2406 

0.0 

9.0098 

-0.0340 

-0.6040 

0.0 

o 

• 

o 

1.0 

0.0358 

0.0 

The  B  Matrix  is 


B  - 


’  -0.0022 
13.5934 
0.1488 
0.0 


-0.0388  ' 
-1 . 4674 
-4 . 5577 
0.0 


For  these  Matrices,  the  state  vector  x  and  control  vector  u 
are 


Here,  ft  is  the  yaw  angle,  p  is  the  roll  rate,  r  is  the  yaw 
rate,  ^  is  the  roll  angle,  and  6  and  6  are  the  control 


inputs  for  aileron  and  rudder  deflections.  Alag  and  Duke 
show  the  open-loop  eigenvalues  of  this  system  to  be 


Dutch  Roll:  -0.4088  ±  3.23031 

Roll  Subsidence:  -2.1413 

Spiral:  -0.0209 


Note  that  NODES  shows  that  Alag  and  Duke  have  mislabeled  the 
Dutch  roll  eigenvalues  as  the  short-period  eigenvalues.  The 
desired  closed-loop  eigenvalues  are 


Dutch  Roll:  -2.0  ±  4.01 

Roll  Subsidence:  -4.0 

Spiral:  -0.002 


The  desired  closed-loop  eigenvectors  are 


Dutch  Roll: 


1  i  Xi  1 
0  ±  Oi 
X  ±  ii 
0  ±  Oi 


Roll 

'  0  ' 

Spiral: 

0  1 

Subsidence: 

1 

X 

0 

X 

L x  J 

1 

•  ■ 

where  the  variable  X  represents  arbitrary  values. 

Alag  and  Duke  state  that  their  optimal  closed-loop 
eigenvectors  are 


Dutch  .99  ±  2.71  i' 

Roll:  -0.21  *  0.001 

12.35  ±  1.091 

-0.35  ±  0. 09i 


Roll 

r  -0.0068  1 

Spiral: 

0.0 

Subsidence: 

1.0 

-0. 0034 

0.0019 

0. 0388 

-0.  25 

1.0 

As  with  the  AFTI/F-16  case,  we  will  select  as  our  arbitrary 
X's  those  values  found  by  Alag  and  Duke.  This  leaves  our 
desired  closed-loop  eigenvectors 


Dutch  i  ±  2.7ii 

Roll:  0  ±  Oi 

12.33  ±  li 
0  ±  Oi 


Roll 

0 

Spiral: 

0 

Subsidence: 

1 

-0.0034 

0 

0.0388 

-0.25 

1 

With  this  as  our  specified  eigenstructure,  we  can  see  if 
MODES  does  calculate  the  proper  feedback  gain  matrix. 

Alag  and  Duke  show  that  the  feedback  gain  matrix  should  be 


'  2.7167 

-0.1422 

-0.0147 

-0.0046  ' 

-2.0771 

m 

-0.0483 

0.7094 

-0.0329 

MODES  calculates  the  feedback  gain  matrix  to  be 


[2.7166  -0.1422  -0.0147  -0.0046 

-2.0769  -0.0483  0.7094  -0.0329 

This  leaves  X  ■  A  +  BG  to  be 


X 


-0. 1391 
-0.0326 
18.8800 
0.0 


0.0380 

-4.0036 

0.1651 

1.0 


-1.0269  0.0400 

-0.0003  -0.0136 

-3.8393  0.1494 

0.0338  0.0 


MODES  shows  the  optimal  closed-loop  eigenvectors  to  be 


Dutch 

Roll: 


.99  ±  2. 7ii" 
-0.021  =F  0. 001 
12.33  ±  1.001 
-0.035  *  0.091 


Roll 

r  -0.0068  i 

Spiral: 

r  0.0  1 

Subsidence: 

1.0 

-0.0034 

0.0019 

0.0388 

-0.  25 

1.0 

Note  the  differences  in  the  Dutch  Roll  eigenvectors  found  by 
NODES  and  those  presented  by  Alag  and  Duke.  The  IMSL 
library  routine  EIGRF  agrees  with  NODES.  Again,  as  with  the 
AFTI/F-16  case,  we  have  excellent  agreement  between  NODES 
and  a  known  problem. 


Discussion  of  Routines 


SVD. 

The  subroutine  SVD  is  a  modified  version  of  the  routine 
CSVD,  found  as  '* Algorithm  358-Singular  Value  Decomposition 
of  a  Complex  Matrix"  (Businger  and  Golub,  1980:  358-P-l , 
358-P-2)  in  Collected  Algorithms  from  CACM.  CSVD  is  written 
for  complex  matrices.  SVD  is  a  modification  of  CSVD  to 
address  real  matrices. 

As  found  in  Chapter  II,  the  singular  value  decomposi¬ 
tion  of  the  n  by  m  matrix  A  is 

A  -  UZVT  C2.6> 

Here,  the  matrix  U  consists  of  the  n  orthonormal ized  eigen¬ 
vectors  asssociated  with  the  n  eigenvalues  of  AAT.  The 
matrix  V  consists  of  the  m  orthonormal ized  eigenvectors  of 
AtA.  The  diagonal  elements  of  Z  are  the  non-negative  square 
roots  of  the  eigenvalues  of  ATA,  and  are  called  the  singular 
values. 

Although  one  might  decide  to  calculate  the  singular 
values  of  A  by  finding  the  eigenvalues  of  ATA,  needless 
errors  can  result.  As  an  example,  let 


1 


A  - 


1  ‘ 
0 

y  . 
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and  the  singular  values  are  |2+y  j  and  |y|,  showing 

that  A  has  rank  2.  However,  if  |y|  is  less  than  the 
floating  point  accurracy  of  the  computer  used  then 


[:  i] 


and  the  singular  values  would  be  given  as  y/2  and  0, 
indicating  that  A  has  rank  1.  Therefore,  by  working  with 
AtA  directly,  we  are  apt  to  introduce  unnecessary  errors 
CiClema  and  Laub,  1980:  1<S7>.  SVD  uses  Householder  transfor¬ 
mations  to  reduce  A  to  bidiagonal  form,  and  then  the  QR 
algorithm  to  find  the  singular  values  of  this  bidiagonal 
matrix.  For  this  routine,  we  assume  that  A  is  dimensioned  m 
by  n,  and  that  m  2:  n  .  If  m  <  n  we  perform  SVD  on  the 
transpose  of  the  matrix. 


Reduction  to  Bldlagonal  Form  < Golub  and  Reinsch,  1970: 
404-405).  A  Householder  transformation  is  an  orthogonal  and 
symmetric  matrix  D  of  the  form 


D  -  I  -  — - — -  v  v  T 

l|v||2 


where  v  is  an  orthogonal  transformation  vector.  In  our 
application,  we  will  construct  two  finite  sequences  of 
Householder  transformations 


pi  1C  J 


I 


2xl * J  x 1  *  1 


C k=l , 2,  .  . . , n> 


and 

Qck3  =  I  -  2y c  k  3  y c  k  3  T  Ck=l,2, . . . ,n-2> 

where  x ( k 3  and  y c  k  5  have  been  normalized,  so  that, 

— Ck)  XCk3  =  y C  k  3  y C  k  3  =  1 

This  will  give  us 

PCnJ. . .PC13AQC13. . .  Q c  n  ~  2  3 


L  0 

-  j<-> 

Here,  JCo3  is  an  upper  bidiagonal  matrix  dimensioned  m  by  n 
The  upper  partition  shown  is  dimensioned  n  by  n,  and  the 
lower  partition  is  Cm— n>  by  n. 

Letting  AC13  ■*  A  ,  define 

A<k+i'23  _  pck>  Ack>  ck-i.2 . n> 

Ack*13  .  A<k-i/2Jock)  Ck“l , 2 . n> 


This  leaves 


A  =  P  A  Q  Ck=l , 2, . . . , n-2> 

Using  the  notation  a  *  k  5  to  represent  the  element  in  the 
il h  row  and  jl h  column  of  the  matrix  Ack),  we  will  detei — 
mine  Pck:>  such  that 


_ C  k  +  1/2 5 

a  i 

i  k 


0 


C i=k+l , . . . , m) 


and  Qck)such  that 

ak j  + 1 5  “  0  Cj-k+2,. . . ,n> 

This  leaves  Jto)  to  be  bidiagonal,  as  desired,  with  zeroes 
everywhere  except  along  the  main  diagonal,  and  along  the 
first  diagonal  above  the  main  diagonal.  If  the  matrix  JCo 
has  the  singular  value  decomposition 

JCoJ  -  GXHt 


then 


,(n) 


PC1)AQ<° 


Q 


tn-2) 


GXH 


Because  the  Pck)  and  Qck)  matrices  are  orthogonal,  we  can 
write 


.c  t ) 


.C  23 


PCn)  GXHTQ(n  2 5 


.  .  .  Qc 


i  ) 


Recalling  that  the  Householder  transformation  produces 
matrices  which  are  both  orthogonal  and  symmetric,  we  have 


A  *  PC1J. . . PCn5GXHTQCn"25  ...QC1J 


For  notational  convenience,  we  will  denote  the  products 
Pcl}...PCr°  and  QC1J . . .QCn-25  as  P  and  Q,  respectively. 


This  leaves 


A  =  PQZHtQt 


Strang  shows  that  multiplication  by  an  orthogonal  matrix  T 
preserves  lengths  (Strang,  1976:  121).  That  is, 

I |Tx| |  -  ||x|| 

for  every  vector  x.  This  multiplication  also  preserves 


inner  products: 


CTx)T(Ty)  -  xTy 


for  all  vectors  x  and  y.  With  this,  and  because  P  and  Q 
are  orthogonal,  we  find  that  the  singular  values  of  JCo)  a 
the  same  as  those  of  A.  With 


UZVT  *  A  *  PGXHTQT  -  PJCo5Qt 


we  have  U  ■  PG  and  V  ■  QH  Therefore,  given  the 

singular  value  decomposition  of  JCo>,  we  can  find  the 
singular  value  decomposition  of  A.  Our  next  task  is  to 
perform  the  singular  value  decomposition  of  the  bidiagonal 
matrix  Jc 0) . 

Sincular  Value  Decomposition  of  the  Bidiagonal  Matrix 


(Golub  and  Reinsch,  1970:405-406).  Using  a  variation  of  the 
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QR  Algorithm,  we  diagonalize  the  matrix  J  °  iteratively 
such  that  JCo3  becomes  JC15,  which  becomes  which 

becomes  I.  Here, 


r(l  ♦! 


where  S<l3  and  TCv5  are  orthogonal.  The  matrices  Sc 1 5  are 
chosen  so  that  all  Jco  are  bidiagonal,  while  the  matrices 
TtvJ  are  chosen  so  that  the  sequence  ■  Jtl5TJt*') 

converges  to  a  diagonal  matrix.  For  notational  convenience, 
let 


J  «  J<0,  3  -  JCi*iJ,  S  -S*0,  T  ■  Tc  1 5 , 

M  -JTJ,  »  -  3T3 

Now  we  will  use  a  method  called  Givens  rotations  to  elimi¬ 
nate  off-diagonal  terms  so  as  to  transform  J  to  a  diagonal 
matrix.  Ve  achieve  this  transformation  from  J  to  3  by 
applying  a  Givens  rotation  to  J  first  from  the  right,  then 
from  the  left,  and  continuing  to  alternate  such  that 


3 


STs7  ... sTjT  T  .  .  .  T 

n  (n-l)  2  23  r 


StJT 


(4. 1> 


where. 


vs 


1 

0 


cos<0.  ) 
k 

sin<0.  ) 
k 


-sinCeu> 

k 

cos(0,  ) 
k 


o 

i 


and  Tk  is  similarly  defined  with  ^k  instead  of  @k.  The 
cos<0k>  terms  are  on  the  main  diagonal,  in  the  Sk<k-l,k-l> 
and  SfeCk,k>  positions. 

Because  we  apply  the  Givens  rotation  first  from  the 
right,  we  first  deal  with  the  T2  matrix.  Denoting  the  non¬ 
zero,  non-unity  elements  as  #,  we  have,  for  a  sample  5  by  5 
matrix. 


#  #  0 

0  0  0 

0  0  0 

0  0  0 

0  0  0 


0  0  ' 
0  0 
0  0 
0  0 
0  0 


*  0  0 
0  0 
0  0 
0  0 
0  0 


0  0  0 
0  0  0 
10  0 
0  10 
0  0  1 


■##  0  0  0' 
###00 
0  0  #  #  0 

0  0  0  ## 

0  0  0  0  # 


Ve  see  that  where  J  was  bidiagonal,  JT2  is  almost  bidiag¬ 
onal,  with  an  additional  non-zero  element  in  the  2,1 
position.  The  angle  associated  with  T2  is,  at  this 
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point,,  arbitrary.  All  other  angles  are  chosen  so  that  J  has 
the  same  form  as  J.  The  angle  ©2  associated  with  S2  Is 
chosen  so  that  the  product  S2tJT2  annihilates  the  element 
in  the  2,1  position. 

Here, 

##ooo]r##ooo 

##000  ###00 

S„TJT  *  00100  0  0  #  #  o 

2  2 

00010  000## 

ooooij[oooo# 

###oo]  r###oo 

X  #  #  0  0  0  #  #  0  0 

0  0  #  #  0  -  0  0  #  #  0 
000##  000## 
0000#J  0  0  0  0  # 

Again,  the  angle  ©2  is  chosen  such  that  the  X  in  the  2,1 
position  equals  zero.  No*  ve  have  introduced  a  non-zero 
element  in  the  1,3  position.  To  make  this  element  zero,  the 
angle  S  associated  with  T  is  appropriately  selected. 
Similarly  to  before,  the  product  S_tJT  T  will  introduce  a 
non-zero  entry  in  the  3,2  position.  Continuing  to  alternate 
these  multiplications,  we  finally  find  that  S^T  annihilates 
a  non-zero  entry  in  the  n,<n-l>  position,  while  generating 
no  new  non-zero  entries.  Therefore,  3  is  also  bidiagonal. 

Since  3  ■  StJT 


ft  =  J  3  -  ttjtsstjt 


Because  S  is  orthogonal,  ft  =  TtJtJT  *  TtMT  ,  and  ft  is  a 


tri-diagonal  matrix,  as  is  M.  Ve  now  will  see  that  the 
selection  of  the  angle  4' 2  associated  with  the  matrix  T2,  up 
to  now  an  arbitrary  angle,  can  be  chosen  so  that  the  tran¬ 
sition  from  M  to  ft  is  a  QR  transformation  with  a  given  shift 
s.  A  QR  transformation  is  an  algorithm  used  to  calculate 
the  eigenvalues  and  eigenvectors  of  a  matrix.  Convergence 
of  this  algorithm  can  be  accelerated  if  we  properly  shift 
the  eigenvalues  of  the  matrix  M  by  an  amount  s  CPress,  et 

al,  1986:  356-363>. 

The  usual  QR  algorithm  with  shift  s  is  described  as: 


N  -  si  ■  T  R 

a  a 

R  T  ♦  si  -  ft 


(4.2) 


where  Ta  Ta  =  I  ,  and  Ra  is  an  upper  triangular  matrix. 


With  T  tT  —  I  ,  we  have 


R  T  «TtTRT  «  T  t(T  R  )T  -  T  t(H-sI)T 

o  a  a  a  a  a  a  aaa  a  s 


Therefore, 


R  T  +  si  -  T  t(H-sI)T  ♦  si  -  ft 

a  a  a  a  c 


T  tMT  -  T  t(sI)T  +  si  -  ft 

aaa  a  s 


This  gives 


T  tMT  -  ft 


i  Aa  JLrn A  aV  JV 


Golub  and  Reinsch  C Golub  and  Reinsch,  1970: 406>  show  that  we 
do  not  have  to  compute  Eq  (4.2>  explicitly,  but  that  we  can 
implicitly  perform  the  shift.  For  now,  let  T  be  an  arbi¬ 
trary  matrix  such  that  the  elements  of  the  first  column  of  T 

are  equal  to  the  elements  of  the  first  column  of  Ta.  That 
is, 

T<k,l)  -  TaCk,l>  Ck-1,2, . . . ,n> 

Also,  we  must  have  TtT  *  I  .  Given  this,  Golub  and 
Reinsch  present  the  following  theorem,  offered  without 
proof: 

If  i>  8  ■  TtNT, 

ii)  ft  is  tri— diagonal , 

and  iii)  the  sub-diagonal  elements  of  N  are  zero, 

then  ft  «  Dft#D  where  D  is  a  diagonal  matrix  whose  diagonal 
elements  are  ±1. 

By  choosing  the  angle  ©2  associated  with  the  matrix  T2 
such  that  the  first  column  of  T2  is  proportional  to  the 
first  column  of  M-sI,  then  the  first  column  of  the  product 
X  m  T  T  .  .  .  T  is  also  proportional  to  the  first  column  of 
N-sI.  Remembering  that  the  first  column  of  T  is  identical 
to  the  first  column  of  T  ,  then,  if  the  sub-diagonal  of  M 
does  not  contain  any  non-zero  entry,  the  theorem  conditions 
are  met.  Therefore,  T  is  identical  to  Ta  Cup  to  a  scaling 
of  column  ±1).  The  transition  in  Eq  <4.1>  is  equivalent  to 
the  QR  transformation  of  JTJ  with  a  given  shift  s. 

The  shift  parameter  s  is  given  as  an  eigenvalue  of  the 
lower  2  by  2  minor  of  N.  For  this  choice  of  s,  the  method 
converges  globally,  and  usually  converges  cubically.  Now  we 
must  determine  when  we  have  found  the  3  which  ends  our 


search. 


Test  for  Convergence  < Golub  and  Reinsch,  1970: 407>. 
With  the  Matrix  J  and  a  prescribed  tolerance  6,  we  are 
ready  to  exaMine  the  system  for  convergence.  If  |e^ |  S  6 
then  we  accept  |q  |  as  a  singular  value,  and  we  reduce  the 
order  of  the  matrix  by  one.  If  |ej  S  6  for  k  *  n  , 
then  we  break  the  matrix  into  two  separate  blocks,  and 
independently  compute  the  singular  values  of  both  blocks. 

If  ■  0  ,  then  we  have  at  least  one  singular  value 

equal  to  zero.  Provided  we  have  no  roundoff  error,  the 
matrix  will  break  if  we  perform  a  shift  of  zero.  Therefore 
assume  that  at  some  stage,  |qk |  £  &  At  this  stage,  we 
apply  an  extra  sequence  of  Givens  rotations  to  J  from  the 
left  involving  rows  k  and  k+1 ,  rows  k  and  k+2 , . . . ,  and  rows 
k  and  n.  Doing  this,  we  have  formed  the  matrix 


With  the  construction  of  the  J  matrix  with  the  extra 
sequence  of  Givens  rotations,  orthogonality  provides  that 


V  ♦  Sl 


«52  -  q?  2S  S2 

n  W 


Our  remaining  task  is  to  choose  an  appropriate  6  such  that 


Note  that  for  an  n  by  n  A  matrix,  and  an  n  by  m  B  matrix, 
the  basic  augmented  matrix  is  dimensioned  n  by  <n+m). 

Because  the  routine  SVD  is  written  for  real  matrices 
only,  the  augmented  matrix  involving  complex  eigenvalues 
must  be  altered.  If  we  write  the  complex  eigenvalue 

"  ^rk  +  k 

where  Xr  is  the  real  component  of  the  kl h  eigenvalue  and 
Xl  k  is  the  complex  component,  the  altered  augmented  matrix 
can  be  written  as  <Silverthorn  and  Reid,  1980:  1207) 


‘  A  -  XrkI  j 

:  xvki  j 

i _ ! _ i 

1  0 

-x  .i  j 

t  k  1 

!  A-x”I  i 

!  o  i 

!  B 

For  an  n  by  n  matrix  A  and  an  n  by  m  matrix  B,  the  altered 
augmented  matrix  is  dimensioned  2n  by  2(n+m). 

In  chapter  II,  when  calculating  the  null  space  of  the 
augmented  matrix,  we  represented  the  null  space  as  a  matrix 
of  vectors 


The  upper  partition  contains  the  closed-loop  eigenvectors  of 
the  matrix  A,  and  the  lower  partition  is  the  product  of  the 
feedback  gain  matrix  and  the  matrix  of  closed-loop  eigen¬ 
vectors.  For  a  complex  eigenvalue,  we  have  one  column  of 
the  complex  null  space  matrix  in  the  form  CSilverthorn  and 
Reid,  1980:  1207) 


Prk 

|\k 

GPrk 

°i\k 


As  before,  the  subscripts  rk  refer  to  the  real  components  of 
the  kl h  eigenvector  and  the  subscripts  ik  refer  to  the 
imaginary  components. 

/.v, 

The  NODES  subroutine  SETUPC  is  used  to  set  up  the 
altered  augmented  matrix,  and  is  used  whether  the  augmented 
matrix  is  real  or  imaginary.  Naturally,  when  SETUP  is  used 
with  real  eigenvectors,  k  is  set  equal  to  zero. 

Because  the  subroutine  SVD  is  written  to  perform  the 
singular  value  decomposition  on  a  matrix  which  has  either 
more  rows  than  columns  or  an  equal  number  of  rows  and 
columns,  and  because  the  augmented  matrix  will  always  have 
more  columns  than  rows,  the  subroutine  SETUPC  defines  the 
augmented  matrix  to  be  the  transpose  of  the  matrix  defined 
above.  This  way,  SVD  can  perform  properly.  The  only 
modification  required  for  the  routine  SVD  is  in  our  call 
statement.  Ve  can  see  that  if  the  singular  value  decompo¬ 
sition  of  the  matrix  A  is 


*  -  «»*avI 
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then  the  singular  value  decomposition  of  the  transpose  of  A 
is 


vA^X 


T 

But,  the  singular  value  decomposition  of  A  can  also  be 
written  as 


At 


u 


Therefore,  if  we  want  the  singular  value  decomposition  of  A, 

but  are  limited  to  using  AT,  then  we  can  do  this  provided 

we  recognize  that  the  U  _  and  the  V  „  matrices  associated 

at  at 

with  the  matrix  AT  are  the  same  as  the  VA  and  UA  matrices, 
respectively.  With  this  in  mind,  when  we  want  the  singular 
value  decomposition  of  the  augmented  matrix,  we  switch  the 
locations  of  U  and  V  in  the  call  statement,  and  apply  SVD  to 
the  transpose  of  the  augmented  matrix. 

Pseudo i n verse  of  the  Range  Space.  After  applying  SVD 
to  the  transpose  of  the  augmented  matrix  [A-V  I,B1,  we  use 
the  null  space  defined  by  V2  from  Chapter  II  to  find  the 
range  space  of  achievable  eigenvectors.  When  the  matrix  A 
is  dimensioned  n  by  n,  this  range  space  is  the  first  n  rows 
of  the  null  space  matrix  V  .  If  the  eigenvalue  used  in  the 
augmented  matrix  is  complex,  the  range  space  is  the  first  2n 
rows  of  V  .  Subroutine  V2DEF  defines  the  null  space  matrix 
from  the  singular  value  decomposition  of  the  transposed  aug¬ 
mented  matrix,  and  subroutine  V2SDEF  defines  the  range  space 
of  achievable  eigenvectors  from  V  .  This  range  space  matrix 
called  V2S  in  NODES,  is  dimensioned  n  by  n  when  the  associ- 


ated  eigenvalue  Is  real,  and  it  is  dimensioned  2n  by  2n  when 
the  associated  eigenvalue  is  complex. 

The  subroutine  SVD  is  applied  to  the  square  matrix 
V2S  directly.  Because  SVD  is  written  for  matrices  which  are 
square,  or  which  have  more  rows  than  columns,  no  special 
considerations  are  required  here  as  they  were  for  the  aug¬ 
mented  matrix. 


Calculating  the  Eigenstructure  of  a  Matrix. 

The  subroutine  EIGV,  developed  specifically  for  MODES, 
is  a  calling  routine  which  calls  the  subroutines  BALANC, 
ELMHES,  ELTRAN,  HQR2,  and  BALBAK,  in  that  order,  to  find  the 
eigenvalues  and  eigenvectors  of  a  general,  real  matrix. 
Because  these  five  routines  found  in  the  EISPACK  manual 
C Smith,  1076:  200-210,  310-319,  338-348>  destroy  the 
original  matrix,  EIGV  also  uses  the  subroutine  COPYAB  to 
create  a  duplicate  matrix  which  is  then  entered  in  the 
series  of  EISPACK  routines.  This  way  we  retain  the  original 
matrix  while  computing  its  eigenstructure.  Because  our 
earlier  discussion  of  the  subroutine  SVD  examined  in  detail 
a  variation  of  the  QR  algorithm  found  in  HQR2,  we  will 
discuss  these  routines  only  in  general  terms  here. 

Balancing  a  Real  General  Matrix  CParlett  and  Reinsch, 
1969:  293—304) .  The  first  of  our  EISPACK  routines,  BALANC, 
is  derived  from  the  Algol  procedure  "balance”  by  Parlett  and 
Reinsch.  Because  most  eigenvalue  programs  usually  result  in 
errors  proportional  to  the  Froebinius  norm  of  the  matrix  of 
interest,  the  purpose  of  BALANC  is  to  reduce  the  norm  of  a 
matrix  without  changing  its  eigenvalues.  The  Froebinius 
norm  of  a  matrix  A,  | | A^ | | ,  is  often  used  to  characterize 
the  "size"  of  a  matrix.  The  Froebinius  norm  is  defined  as: 


where  a  is  the  element  in  the  i  row  and  j  column  of  A. 

>•  j 

When  two  matrices  have  the  same  eigenvalues,  they  are  said 
to  be  similar  (Strang,  1976:  221).  Therefore,  by  performing 
similarity  transformations  on  the  original  matrix  to  find  a 
similar  matrix  with  a  reduced  norm,  we  generate  a  ‘’balanced" 
matrix  whose  eigenvalues  we  are  able  to  calculate  with 
greater  accuracy,  and  whose  eigenvalues  equal  the  eigen¬ 
values  of  the  original  matrix. 

While  the  eigenvalues  of  the  balanced  matrix  equal  the 
eigenvalues  of  the  original  matrix,  the  eigenvectors  of  the 
two  matrices  are  not  equal.  Therefore,  the  subroutine 
BALBAK  is  needed  to  "back  transform"  the  eigenvectors  of 
the  balanced  matrix  into  the  eigenvectors  of  the  original 
real,  general  matrix. 

Reducing  a  General  Matrix  to  an  Upper-Hessenberg  Matrix 
(Martin  and  Wilkinson,  1968:  349-368).  Because  several 
algorithms  which  find  the  eigenstructure  of  matrices  have 
fewer  calculations  to  perform  when  the  matrix  has  an  uppei — 
Hessenberg  form,  we  want  to  transform  our  balanced  matrix  to 
an  upper-Hessenberg  matrix  without  destroying  the  eigen- 
structure  of  the  original  matrix.  An  upper-Hessenberg 
matrix  is  a  matrix  of  the  form 


where  the  X’s  represent  unspecified  values,  and  where 
h^  *  0  Ci  >  j+i).  For  an  n  by  n  general  matrix,  the 
number  of  operations  required  by  the  QR  method  of  calcu¬ 
lating  the  eigenstructure  (the  method  employed  by  HQR2)  is 
on  the  order  of  n3;  if  the  QR  method  is  applied  to  upper- 
Hessenberg  matrices,  the  number  of  calculations  required  are 
on  the  order  of  n2  CStrang,  1976:  281).  ELMHES  uses 
similarity  transformations  to  convert  our  balanced  matrix 
into  an  upper-Hessenberg  matrix.  As  with  BALANC,  these 
similarity  transformations  leave  the  upper-Hessenberg  matrix 
with  eigenvalues  equal  to  the  balanced  matrix  eigenvalues, 
and  therefore  equal  to  the  original  matrix  eigenvalues. 
However,  again  as  with  BALANC,  the  similarity  transforma¬ 
tions  alter  the  eigenvectors  of  the  matrix.  Therefore,  the 
subroutine  ELTRAN  is  used  to  accumulate  these  transforma¬ 
tions  into  a  transformation  matrix  to  be  used  by  HQR2  to 
convert  the  eigenvectors  of  the  uppei — Hessenberg  matrix  into 
the  eigenvectors  of  the  balanced  matrix.  From  here,  as 
discussed  above,  BALBAK.  transforms  the  eigenvectors  of  the 
balanced  matrix  into  the  eigenvectors  of  the  original 
general  matrix. 

Calculating  the  Eigenstructure  of  an  Upper-Hessenberg 
Matrix  CStrang,  1976:  280-282).  The  EISPACK  subroutine 

HQR2  is  derived  from  the  Algol  procedure  hqr2  CPeters  and 


Wilkinson,  1970:  191-197).  Using  the  shifted  OR  algorithm 


HQR2  finds  the  eigenvalues  and  eigenvectors  of  the  upper- 
Hessenberg  matrix  in  a  similar  manner  to  the  way  SVD  finds 
the  eigenstructure  of  a  bidiagonal  matrix.  Where  SVD 
iterated  on  the  bidiagonal  matrix  until  the  off-diagonal 
elements  approach  zero,  HQR2  uses  Householder  transforma¬ 
tions  to  iterate  on  the  subdiagonal  elements  so  that  they 
approach  zero.  This  leaves  the  eigenvalues  to  be  the 
elements  of  the  main  diagonal.  The  last  element  of  the  main 
diagonal  is  the  one  which  normally  approaches  the  eigenvalue 

first.  This  leaves  our  transformed  matrix  A,  to  look  like 

k 

‘  X  X  X  X  X  ‘ 

X  X  X  X  X 

Ak  *  0  X  X  X  X 

0  0  X  X  X 

0  0  0  e  X, 

with  e  «  1 

At  this  point,  the  QR  algorithm  continues  to  work  on 
the  n-i  by  n-1  sub-matrix  found  in  the  first  n-1  rows  and 
columns  of  A,  .  In  this  fashion,  we  continue  to  find  an 

k 

eigenvalue,  reduce  the  size  of  the  matrix,  find  another 
eigenvalue,  and  repeat  this  reduce/find  eigenvalue  process 
until  all  eigenvalues  have  been  found.  By  using  back- 
substitution,  we  use  the  zero  elements  produced  by  the 
Householder  transformations  to  find  the  eigenvectors. 

That  is,  given  the  defining  equation  of  an  eigenvalue  X  and 
an  eigenvector  x  for  a  matrix  A, 


we  use  the  information  in  the  last  row  of  the  Hessenberg 
matrix,  along  with  each  eigenvalue,  to  directly  find  the 
last  component  of  each  eigenvector.  Then  we  use  the  next- 
to-last  row  of  the  matrix  and  the  last  component  of  the 
eigenvectors  to  solve  for  the  next-to-last  component  of 
the  eigenvectors.  Ve  continue  to  back-substitute  in  this 
manner  until  all  of  the  components  of  all  eigenvectors  have 
been  found. 

Now  we  have  the  eigenstructure  of  the  upper-Hessenberg 
matrix.  By  multiplying  the  matrix  of  eigenvectors  by  the 
accumulated  transformations  from  ELTRAN,  found  in  a  single 
transformation  matrix,  we  get  the  eigenvectors  of  the 
balanced  matrix.  At  this  point,  our  only  remaining  task  is 
to  find  the  eigenvectors  of  the  original  general  matrix  from 
the  eigenvectors  of  the  balanced  matrix.  Again,  this  is 
performed  by  the  subroutine  BALBAK. 

Defining  and  Printing  the  Eigenstructure. 

The  subroutine  EIGSTR  asks  the  user  to  define  the 
desired  eigenstructure  for  NODES.  When  the  A  matrix  of  the 
equation  x  =  Ax  +  Bu  is  dimensioned  n  by  n,  then  the 
system  has  n  eigenvalues  and  n  eigenvectors.  The  eigen¬ 
vectors  are  stored  in  a  2n  by  n  array  called  EVEC,  and  the 
eigenvalues  are  stored  in  a  2n  by  1  array  called  EVAL.. 

The  first  column  of  the  eigenvector  array  is  the 
eigenvector  associated  with  the  first  eigenvalue  of  the 
eigenvalue  array.  Similarly,  the  il h  column  of  the 
eigenvector  array  is  the  eigenvector  associated  with  the 
il h  eigenvalue  of  the  eigenvalue  array.  The  first  n 


elements  of  any  eigenvector  column  are  the  real  components 
of  the  eigenvector,  and  the  last  n  elements  of  the  eigen¬ 
vector  column  are  the  imaginary  components  of  the  eigen- 


vector.  The  jl h  element  Cl  £  j  £  n)  of  the  eigenvalue 
array  is  the  real  component  of  the  jl h  eigenvalue;  the 
j  ♦  nl h  element  is  the  imaginary  component  of  the  jl h 
eigenvalue. 

By  storing  the  desired  eigenstructure  in  this  form,  we 
are  prepared  to  project  the  desired  eigenvectors  into  the 
range  space  of  achievable  eigenvectors  as  discussed  in 
Chapter  II  and  in  the  section  “Setting  Up  Matrices  for 
Singular  Value  Decompost ion"  of  this  chapter. 

Because  complex  eigenvalues  and  eigenvectors  must 
appear  in  complex  conjugate  pairs,  EIGSTR  automatically 
defines  the  complex  conjugates. 

When  MODES  calculates  the  eigenstructure  of  a  matrix, 
the  eigenstructure  is  stored  in  a  different  manner.  This 
different  storage  is  the  format  used  by  the  EISPACK  routines 
HQR2 ,  ELHHES,  ELTRAN,  BALANC,  and  BALBAK  (Smith,  et  al, 
1976).  Instead  of  storing  the  eigenvectors  in  a  2n  by  n 
array  as  in  EIGSTR,  these  eigenvectors  are  stored  in  an  n  by 
n  array.  Also,  where  EIGSTR  stores  the  eigenvalues  in  a 
single  2n  by  1  array,  these  eigenvalues  are  stored  in  two 
separate  n  by  1  arrays,  one  array  for  the  real  components  of 
the  eigenvalues,  and  the  second  array  for  the  imaginary 
components. 

When  the  il h  eigenvalue  is  real,  that  is  when  the  il h 
element  in  the  array  of  imaginary  components  of  the 
eigenvalues  equals  zero,  then  the  eigenvector  associated 
with  this  eigenvalue  is  found  in  the  il h  column  of  the 
eigenvector  array.  Vhen  the  il h  eigenvalue  is  the  first  of 
a  pair  of  complex  conjugate  eigenvalues,  then  the  il K  column 
of  the  eigenvector  array  contains  the  real  components  of  the 
associated  eigenvector,  and  the  i+lal  column  contains  the 
imaginary  components.  Because  the  i+lai  eigenvalue  will 


be  the  complex  conjugate  of  the  il  h  eigenvalue,  we  know  that 
the  i+l"1  eigenvector  is  the  complex  conjugate  of  the  il h 
eigenvector.  The  subroutine  PRINTZ  prints  the  eigenstruc- 
ture  stored  in  this  format. 

Calculating  the  Modified  System  Matrix. 

As  was  shown  in  chapter  II,  the  modified  closed-loop 
system  matrix  X  is  given  as 

X  ■  A  +  BG  C2.1> 

Here,  the  matrices  A  and  B  are  defined  for  the  linear  time 
invariant  state-space  model 

x  =  Ax  +  Bu  Cd.3) 

The  matrix  G  is  the  feedback  gain  matrix  required  to  give 
the  closed- loop  system 


x  ~  Xx  C3.i> 

the  desired  response  characteristics  as  described  by  the 
eigenstructure  of  X.  The  subroutine  ATLDEF  calculates  X 
from  A,  B,  and  G.  Chapter  II  gives  the  feedback  gain  matrix 

G  as 

G  =  RP1  (2. 3> 

O 

Here,  the  Pq  matrix  is  the  matrix  of  optimal  eigenvectors 
found  by  projecting  the  desired  eigenvectors  into  the  range 
space  of  achievable  eigenvectors.  As  was  discussed  in 
Chapter  II,  the  R  matrix  consists  of  the  lower  partition  of 


the  vectors 


The  upper  partition  of  these  vectors  are  the  optimal  projec¬ 
tion  of  the  desired  eigenvectors  into  the  range  space  of  the 
achievable  eigenvectors. 

To  find  the  P  and  R  matrices,  we  use  subroutine  PDDEF 

O  9 

to  define  a  desired  eigenvector  PD  from  the  matrix  EVEC 
which  was  defined  in  the  subroutine  EIGSTR,  and  the 
subroutine  SVD  is  used  as  outlined  in  chapter  II.  See 
"Defining  and  Printing  the  Eigenstructure"  above  for  more 
information  on  the  matrix  EVEC. 

In  the  discussion  "Setting  Up  Matrices  for  Singular 
Value  Decomposition"  above,  we  have  stored  the  range  space 
of  achievable  eigenvectors  in  the  matrix  V2S.  As  previously 
stated,  we  need  to  project  the  desired  eigenvectors  into 
this  range  space.  Using  the  methods  of  chapter  II,  we  do 
this  by  performing  the  singular  value  decomposition  of  the 
matrix  V2S,  and  calculate 

CPA)  «  C  V2S) VZ*UT(PD) 

Here,  V  and  U  come  directly  from  the  subroutine  SVD.  The 
subroutine  ATRANS  defines  the  transpose  of  U,  UT.  The 
vector  PD  is  the  desired  eigenvector.  Z*  is  defined  in 
chapter  II  to  be  a  diagonal  matrix  containing  the  multi¬ 
plicative  inverses  of  the  singular  values  of  V2S  in  the 
first  r  Cr«rank>  elements  of  the  main  diagonal.  The 
subroutine  SIGPL  defines  I+  from  the  singular  value 


decomposition  of  V2S. 

With  this  information,  the  subroutine  AXBEQC  performs 
the  required  matrix  multiplications  to  find  the  optimal 
eigenvectors  PA.  Subroutine  PACHDF  defines  the  matrix  of 
optimal  eigenvectors  PACH  from  each  optimal  eigenvector  PA. 
As  shown  in  chapter  II,  PA  is  dimensioned  2(n+m>  by  1,  and 
PACH  is  2<n+m>  by  n.  As  with  the  matrix  EVEC,  the  first  n 
elements  of  PA  and  the  first  n  elements  of  the  columns  of 
PACH  are  the  real  components  of  the  optimal  eigenvectors, 
and  the  last  n  elements  are  the  imaginary  components.  The 
next  m  elements  are  the  real  components  of  the  column 
vectors  of  the  matrix  R.  The  last  m  elements  are  the 
imaginary  components  of  the  column  vectors  of  R. 

The  subroutine  PNRDEF  uses  the  matrix  of  optimal 
eigenvectors  PACH  and  rearranges  the  information  in  a  form 
suitable  for  matrix  inversion.  The  matrices  formed  are 
the  required  Pq  and  R.  The  n  by  n  matrix  Pq  is  structured 
as  follows.  When  the  il  h  eigenvector  of  the  modified  system 
is  real,  the  il h  column  of  Pq  is  that  eigenvector.  When  the 
il h  eigenvector  is  the  first  of  a  pair  of  complex  conjugate 
eigenvectors,  the  il h  column  of  P  contains  the  real 

O 

components  of  that  eigenvector  while  the  i+i*1  column 
contains  the  imaginary  components.  Because  any  complex 
eigenvector  must  have  associated  with  it  a  complex  conju¬ 
gate,  storing  one  complex  eigenvector  effectively  stores  the 
information  of  two  eigenvectors.  The  R  matrix  defined  by 
PNRDEF  is  structured  similarly  to  P  . 

O 

Using  the  subroutines  INVERT,  FACTOR  and  SUBST,  we  now 
find  the  inverse  of  Pq,  P  4.  Multiplying  R  by  P”1,  we  have 
the  feedback  gain  matrix  G  required  to  optimize  our  system’s 
time  response  characteristics. 

Subroutine  ATLDEF  now  multiplies  the  matrices  B  and  G, 


and  adds  this  product  to  the  matrix  A  to  yield  the  modified 
system  matrix  X. 

Discretizing  and  Plotting  the  System  Time  Response  (Reid, 
1983:  273-277). 

From  the  linear  time-invariant  model 

x(t)  =  Ax(t)  +  Bu(t) 

we  have  the  discrete  time  state-space  model 

x( k)  *  AxT(k-i)  +  Bu( k-1 )  (4. 4) 

T  T  T  T  T 


where 

u  (k)  «  u(t)  CkT  S  t  s  kT  +  T) 

T 

T 

At  =  eAT  Bt  =  [je^d^B 

T  is  a  given  time  Increment,  and  k  is  an  integer  index 
indicating  the  number  of  time  increments  which  have  passed 
since  the  starting  time  t*0.  If  uT(k)  is  exact,  then 

x  (k)  -  x(kT) 

T 

Because  eAT  is  defined  by  (Reid,  1983:  254) 


e 


AT 


I 


a2t2  a3t3 
at  ♦  - ♦  -  ♦ 

2*  3! 


we  have 


V 

V 


a 


Therefore,  we  have 


A2T2  a3t3 


eA*d< 


I  +  AT  + 


B  =  ^IT  + 


A2T3 


♦  .  .  . 


.  .  .  Jl 


In  order  to  define  a  different  power  series  from  which  both 
A_  and  B  can  be  found,  we  can  write 

T  T 


AT2  A2T3 

E  =  IT  +  -  +  - 

2!  3! 


This  leaves 


AT  «  I  +  AE 


For  the  power  series  E  to  converge  to  an  accurate  result,  a 
suitable  combination  of  time  increment  T  and  matrix  A  must 


be  sufficiently 


11".  With  the  "size”  of  the  matrix  A 


given  by  the  Froebinius  norm  ||Ap.||,  we  want  to  find  the 
smallest  integer  N  such  that 


IIVMT 


C4.5) 


Ve  will  use  this  N  in  the  Squaring  Algorithm  to  calculate 


( AT/2N) 


AT  (  AT*  1 

From  this,  e  is  found  by  squaring  e 


KMC 


a  total  of  N  times.  The  Squaring  Algorithm  for  finding  AT 
and  Bt  is  given  as  CReid,  1983:  277>: 

1 .  Given  the  n  by  n  matrix  A,  the  n  by  1  matrix 


4-26 


v  .  a  a r.  -v/A-  A.  *A< 


B,  and  the  time  increment  T,  find  N  such  that 
Eq  (4.5)  is  satisfied. 


2.  Calculate  Eq  from  the  power  series 


E  = 

O 


Terminate  this  series  when  the  last  term 
is  less  than  a  specified  tolerance. 

3.  Calculate  F  such  that 

O 

F  =  I  +  AE  =  eCATy'2N5 

O  O 


C  AT 5 

4.  Now  we  square  the  term  e  N  times 

to  get  eAT.  This  is  done  with  the 
recursion,  N"1 ,2,3, . . . ,N 


E 

F 


M-l 

M-l 


+  F 


M-  1 


M-l 


E 


M-l 


S.  This  leaves 


s  eAT=  Fn 

T 

bt  s  (joeA<d«)B  -  V 

This  algorithm  is  performed  in  the  subroutine  SIMUL8.  With 
Kj,  and  Bx  known,  SIMUL8  calculates  the  time  history  of  the 
system  with  Eq  (4.4)  for  a  step  input.  SIMUL8  records 
the  time  history  of  each  of  the  N  states  in  an  n  by  k 
matrix,  where  k  equals  the  number  of  discrete  points  calcu¬ 
lated  in  SIMUL8.  Row  1  contains  the  time  history  of  state 


1,  Row  2  contains  the  time  history  of  state  2,  and  so  on. 

At  this  point,  SIMUL8  passes  the  time  history  matrix  to  the 
subroutine  which  plots  the  histories,  subroutine  PLOT. 

Plotting.  When  plotting  the  time  history  of  a  general 
system,  we  need  to  know  the  maximum  and  minimum  values  of 
the  state  to  be  plotted  so  as  to  scale  the  output  for  the 
screen.  Because  it  would  be  convenient  for  the  user  to  know 
when  the  state  goes  from  a  negative  value  to  a  positive 
value,  or  vice  versa,  we  will  plot  the  location  of  the  value 
zero.  Ve  can  see  that,  if  we  are  to  show  the  maximum, 
minimum,  and  zero  values,  the  plotting  routine  must 
accomodate  eight  possible  cases  for  a  general  system 
response. 


Case  I 
min<lKmax 


Case  III  min 
min<.max=U  I 


Case  V  min 
min<.max<0  I 


Case  VII  0 
u^min— max 


0  max 


Case  II 


min=0 


max  *  0 


minamax 


min=l 

J<max 

Case 

IV 

min-nax=u 

Case 

VI 

OTmTnTmax 

Case 

VIII 

min=max=0 


min  max 


min*max 


min=max< 


Note  that,  because  the  subroutine  SIMUL8  assumes  initial 
conditions  equal  zero,  cases  V  through  VIII  will  not  occur 
in  MODES.  However,  to  make  PLOT  flexible  for  other  possible 
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applications,  these  cases  have  been  accomodated. 

By  dividing  the  difference  of  the  state  x(t)  and  x(min) 
by  the  difference  of  x(max)  and  x(min),  we  have  a  relative 
’'percentage”  symbol  representing  the  state  at  time  t. 

Here,  x(t)  is  the  value  of  the  examined  state  at  time  t. 

The  values  of  x(min)  and  x(max)  are  the  minimum  and  maximum 
values  of  the  variable  throughout  the  time  interval  examined. 
Similarly,  dividing  the  difference  of  zero  and  x(min)  by  the 
difference  of  x<max)  and  x(min),  we  find  the  location  of  the 
symbol  ”+”  locating  the  zero  value  of  the  state.  PLOT 
prints  the  maximum  and  minimum  values  of  the  state  before 
and  after  plotting  the  time  response  for  easy  examination. 

Finding  the  Resolvent  Matrix  and  the  Poles  and  Zeroes. 

The  Need  for  the  Resolvent  Matrix  (Reid,  1983:  246>. 
Given  the  general  state— space  model  for  an  nl h-order, 

1 -input,  m-output  system 

x(t)  =  Ax(t)  +  Bu(  t)  (4.6) 

y(t)  =  CxCt)  +  Du(t)  (4.7) 

with  a  given  initial  state  x(0)  at  time  tQ,  we  may  want  to 
examine  the  system's  transfer  function,  H(s).  With  the 
transfer  function,  we  can  analyze  the  system  using  the 
classical,  frequency-domain  techniques. 

To  find  the  transfer  function  for  this  system,  we  first 
take  the  Laplace  transform  of  Eq  (4.6)  and  get 


sX(s)  -  x(0) 


AX(s)  +  BU(s) 


Solving  for  XCs)  yields 


XCs)  =  [ sI-A3  1  xCO)  +  Csl  -  A]  4BUCs)  C4.8) 

Using  Eqs  C4.7)  and  C4.8),  we  have  the  Laplace  transform 
of  Eq  <4. 7)  given  as 


YCs)  =  C|[sI-A3_1xC0)  +  CsI-A3-1BUCs)|  +  DUCs) 

=  CtsI— A3  _1xCO)  +^G£sI-A]_1B  +  D^UCs)  C4.9) 

Separating  this  into  the  zero-input  and  zero-state  portions 
CReid,  1983:149),  we  get 


Y  Cs)  ■  Cf  si— A3  ~ 1x(0) 

Z  L 

and  Y^Cs)  *  {C£sl-A3_1B  +  D^UCs) 

jecause  the  zero-state  portion  can  be  used  to  find  the 
transfer  function  HCs)  from  the  relation 

Y  Cs)  -  HCs)UCs) 

Z  8 

we  have  the  m  by  1  transfer  function  given  by 

HCs)  =  GtsI-A3_1B  +  D 

Because  the  matrices  A,  B,  C  and  D  are  all  given  in  the 
general  state-space  model,  only  the  n  by  n  resolvent  matrix 
Csl-A3_1  must  be  found  to  facilitate  using  the  classical 
analysis  tools.  The  subroutine  POLZER  calculates  the  poles 
and  zeroes  by  calling  the  subroutine  RESOLV  to  calculate  the 


resolvent  matrix.  POLZER  then  postmultiplies  this  resolvent 
matrix  by  the  input  distribution  matrix  B.  The  subroutine 
PROOT  is  then  used  to  find  the  roots  of  the  polynomials  in 
this  transfer  function  matrix. 


Calculating  the  Resolvent  Matrix  (Reid,  1983:  449-450). 
To  invert  CsI-AJ,  where  A  is  dimensioned  n  by  n,  we  use 


Csl-Al  1 


adjtsI-A]  _  QCs)  _  Qn-isn  . . Qis  +  Qo 
dettsI-Al  ACs)  sn+  b  +  ...  b  s  +  b 

n  -  1  1  o 


where  the  characteristic  equation  ACs)  is  defined  by 
ACs)  a  dettsl— A]  =  sn  +  b  s”"1  +  ...  b  s  +  b 

n  - 1  11  o 

Here  the  Q. Ci"l ,2, . . . , n)  are  each  n  by  n  matrices. 

The  recursive  algorithm  used  to  calculate  the  matrices 
making  up  QCs)  and  the  coefficients  b^  making  up  ACs)  is 
given  by  the  following  theorem  attributed  to  Leverrier  or 
Faddeev: 

The  matrices  Q^  and  coefficients  b^  may  be 
calculated  recursively  using 


cn  -  1 


=  I 


n  -  i 


=  -trace  CQ  . A)  =  -traceCA  ) 

n  -  1  1 


•n  -2 


Q  A  ♦  b  I  -  A  ♦  b  I 

n - 1  n  ~ 1  1  n-1 


n-2 


-i-  traceCQ  _ A)  =  -i-traceCA  ) 

2  n-2  2  2 


Q  A  +  b  I 
2  2 


A  +  b  I 

n-2  2 


b=  —  — i— •  traceCQ  A)  =  -  —1—  traceCA  ) 

1  n-l  1  n-1  n-1 


QXA  +  btI 


A  +  b  I 

n-1  1 


b  =  -  i.  traceCQ  A)  =  —  —  traceCA  ) 


0 


QA  +  bI  =  A  +  bI 

«  «  ft 


(4.11) 


To  prove  this  recursion  finds  the  matrices  ,  multiply  both 
sides  of  Eq  <4.10)  by  A<s)CsI-Al  to  give 


A<s)I  =  QCsMsI-Al 


<4.12) 


By  substituting  our  expressions  for  ACs)  and  Q<s)  into 
Eq  <4.12),  we  get 

Csn+  b  sn_1  +  ...  +  b  s  +  b  )I  =  Q  sn_1s  -  Q  ,sn_1A) 

n  - 1  1  o  n  -  i  n  - 1 

+  .  .  .+  Qtss  -  QtsA  +  Qq s  -  QoA 

Collecting  similar  terms  of  s  for  the  right-hand  side  of 
this  equation,  we  get 

Csn  +  b  sn-1  +. . . +  b  s  ♦  b  >1  =  Q  sn  + 

n  -  1  1  o  n  -  i 

<Qn_2  -  Qn_lA)sn'1  ♦  ...+  <Qt-  Q2A)s2  ♦  (Qo-  QtA)s  -  QqA 


Equating  like  powers  of  s,  we  have 


1  "  «„-i 

"  «n-2  - 


b2i  -  q4-  o2a 
bi 1  -  0o-  Q,A 

boX  *  QoA 


Rearranging  the  terms  of  these  equations  give  the  previous 
equations  for  this  recursive  routine. 

Before  we  show  that  this  recursion  finds  the  coeffi¬ 
cients  b  ,  we  must,  introduce  some  tools.  The  first  of 

l 

these  is  known  as  Newton’s  Formulas  (Uspensky,  1948:  261). 
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Newton's  Formulas  relate  the  coefficients  of  a  polynomial 


fCx)  =  Cx-\  )(x-X_) . . . Cx-X  )  =  xn+p1xn_1  +...+p 

12  n  1  rn 

to  the  sum  of  the  powers 


a 


+  X 


a 


+  X 


Using  the  notation  sq  to  represent  this  sum  of  powers, 
Newton's  Formulas  state  that 


+  Pisk-i  "*■•••  ♦  kPk  “  0  Ck"i  ,  2,  .  .  .  ,  n-i  ) 

For  our  representation  of  the  characteristic  equation, 
Newton's  Formulas  are  given  as 


s.  ♦  b  4s.  + 

k  n  -  1  k  -  1 


*►  b  s 

n-Ck-25  2 


n-Ck 

Ck-1,2, 


s  ♦  kb  »  0 

1  n-k 

, n-1 )  (4.13) 


Next,  we  will  need  the  following  theorem  (Gantmacher, 
1959:  84): 

If  X  ,  X2 , • • • , X^  are  the  eigenvalues  of  a  matrix 
A,  and  if  g(/i)  is  a  scalar  polynomial,  then  g(Xt),  g(X2), 
g<X  g(Xn)  are  the  eigenvalues  of  g(A).  With  this, 

the  kl h  power  of  A,  Ak,  has  eigenvalues  Xtk,  X2k,...Xnk. 
Because  trace(A)  ■  X  +  X  +.  ..X  ■  a..  +  a,,  ■♦■...♦  a 

1  2  n  11  22  nr. 

where  a  is  the  element  of  A  in  the  il h  row  and  jl h  column. 

<•  j 

we  have 


traceC Ak) 


I  X 


(k  -  0,  1 ,  2, . . . n) 


Note  that  traceCA*)  equals  the  sk  from  Newton’s  Formulas. 
With  these  tools,  we  will  now  show  that  the  Leverrier  or 
Faddeev  recursive  algorithm  does  find  the  required  coeffi¬ 
cients  (Gantmacher,  1959:  87). 

Consider  the  expressions  for  Ak  ,  k  ■  1,  2,  ...,n 


Ve  have 


A  -  0  ,A  -  IA  -  A 

1  r>  -  1 


A  «  (A  ♦  b  I)A  ■  A  ♦  b  A 

2  I  n  -  J  n  1 


A„  -  <A  ♦  b  I)A  -  <  A  ♦  b  A  ♦  b  I)A  - 

3  2  r>  -  2  r,  -  l  r,  2 


A3  ♦  b  A2  ♦  b  A 

n  |  r,  -  2 


Extending  this  to  Ak .  we 


that 


A  *  Ak  ♦  b  Ak  1  ♦ 

k  i  1 


♦  b  A 

r.  '  k  II 


(A  14) 


Now  we  will  equate  the  trace  of  the  left-hand  side  of 
Eq  < 4  14)  to  the  trace  of  the  right-hand  side 


trace*  A  )  ■  s  ♦  b  s  ♦  ♦  b  s  ♦  b  s 

k  k  r.  1  k  I  '  k  J  2  r  k  I  I 


(4  15) 


From  the  recursion  formulas,  Eqs  <4  11),  we  have 


r  trace*  A  ) 

V  k 


This  gives  trace* A  >  •  -k  b 

» 

Eq  *  4  1  5  >  g  l  ves 


Substituting  this  lnt 


-kb 


s .  ♦  b 

k  r 


t  k  -  1 


b  s  ♦  b 

n-(k-J)  2  r.  -  C  k 


S 

I  )  1 


<k  -  1.2, 


.  n) 


These  formulas  are  Newton’s  formulas,  Eq  (4.13),  by  which 
the  coefficients  of  the  characteristic  polynomial  A(s)  are 
determined  successively.  Therefore,  the  given  recursion 
does  find  the  coefficients  of  the  characteristic  equation. 

Note  that  because  this  algorithm  is  known  to  be 
nus^rically  sensitive  and  prone  to  word length-re la ted 
computational  errors  (Reid,  1983.450),  and  because  the 
problem  of  calculating  the  zeroes  of  polynomials  often  Is 
sensitive  to  assail  chances  in  the  coefficients  of  the 
polynomials  (Williams,  1986:  73),  the  Leverrier  or  Faddeev 
recursion  is  implemented  using  Fortran’s  double  precision 
facilities 

F inding  the  Roots  of  a  Polynomial  (Hamming,  1962. 
356-359)  Our  remaining  task  is  to  find  the  poles  and 
zeroes  of  the  product  of  the  resolvent  matrix  and  the  input 
distribution  matrix  We  will  use  the  Bairstow  method  to 
find  these  roots  The  Bairstow  method  works  for  polynomials 
of  degree  3  or  greater 

Let  the  polynomial  of  interest  be 


P(x)  *  a  ♦  a  x  ♦  a  x2  ♦  ♦  a  x 

0  12 

We  will  assume  we  have  a  guess  at  a  quadratic  factor  for 
this  polynomial  of 

x2  ♦  px  ♦  q 

Using  synthetn  division,  we  will  divide  the  polynomial  by 
this  assuwied  quadratu  factor  to  get.  a  quotient,  and  a 
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remainder. 


a  xn  ♦  a  xnl  ♦  .  .  .  ♦  a  » 

n  r>  -  1  o 


Cx2  *  px  ♦  q)(b  xn  2  ♦  b  xn  3 

^  n  n  - 1 


.  +  b  )  +  b  x  +b 

2  1  o 


Equating  like  powers  of  x,  we  find  the  coefficients  b 


to  be 


n 


„  ■  a  ,  -  pb 

n-l  n-l  r  n 


n  -  2  n  -  2 


-  pb  ,  -  qb 

r  n-l  r 


b  .  *  a  ^  -  pb  ,  ,  -  qb 

n  -  k  n  -  k  r  n  -  k  1  ^  n  —  k  ♦ ' 


(k  ■  2,  3, . . . ,  n-l) 


b  ■  a  -  qb 

o  o  2 


(4.16) 


If  the  remainder  of  the  synthetic  division  equals  zero, 
that  is,  if 


b  -  b  -  0 

o  1 

then  the  quadratic  factor  used  is  in  fact  the  quadratic 
factor  we  want.  When  the  remainder  does  not  equal  zero,  we 
must  adjust  our  guess  for  the  quadratic  factor.  To  do  this, 
we  will  assume  the  remainder  coefficients  bt  and  bQ  to  be 
functions  of  the  assumed  quadratic  coefficients  p  and  q. 

1>1  ■  bt(p,q) 

bo  "  boCP'q> 

Now  we  will  use  the  two-dimensional  analog  to  Newton's 


method  and  use  a  Taylor  series  to  expand  bt  and  bQ  about  the 
current  guess  (p,q).  Representing  the  desired  solution  as 

p*  and  q* ,  we  have 

.  ,  <*>  <*> 

b  (p  ,q  )  *  0  =  b  (p,q)  - L  Ap  ♦  - -  Aq  ♦  ... 

1  dp  dq 

•  •  db  dbo 

bQCp  ,  q  )  ■  0  ■  bo(p,q)  *  — —  Ap  — £Aq  ♦  ... 

°  dp 

where  Ap  *  p*  -  p 

Aq  -  q*  -  q 

Ap  and  Aq  are  the  errors  to  be  corrected  for  our  next  guess. 
Using  only  the  first  order  terms  from  these  Taylor  series, 
we  have  two  linear  equations  for  the  changes  to  be  made  in  p 
and  q.  Ve  will  analytically  find  the  partial  derivatives 
for  our  Taylor  series. 

Differentiating  Eqs  (4.16)  with  respect  to  p,  we  get 


(4.17) 

(4.18) 


If  we  use  the  notation 


<4  19) 


then  we  ran  write 


b  -  pC 

n  r  n 

b  -  pC  -  qC 

n»  -  ft  r  r*  -  |  ^  r 


}  —  pC  -  qC 

r»  -  k  ♦  i  k  ♦  1  ^  n  k  ♦  2 


Co  -  -<*' 


(4  20) 


If  we  identify  the  ter*  bk  of  Eq  (4.20)  with  (  of  Eq 
<4.16).  and  C*  with  b  .  . ,  and  if  we  excuse  the  differ- 

n  k  r>  k  ♦  ft 

ence  in  the  last  equation,  then  Eqs  (4  16)  and  (4  20)  are 


of  the  saae  fore.  We  will  now  repeat  the  synthetic  division 
using  the  same  quadratic  factor  x1  ♦  px  ♦  q,  and  perfors  the 
division  on  the  polynomial 


b  ♦  b  x  ♦ 

O  1 


♦  b  x' 


Similar  to  Eqs  <4  16),  this  rives  ui 


►a 


(4.21) 


C  •  b  -  qC 

Usinc  the  notation  in  (4.19),  the  partial  derivatives  with 
respect  to  p  we  are  looking  for  in  Eqs  (4.17)  and  (4.18) 
are 


<*> 

i 

Op 


<*> 

— 2.  -  -c* 

O 


Coaparlnf  Eqs  (4  20)  and  (4.21)  we  see  that 

C*  t  ■  Ck  (k  -  n.  n-1 ,  .3.2) 

G*  *  c,"  b,  ♦  P*2, 


Theref  ore 


-C 


2 


-  “  ■  -( C  -  b  ♦  pC  ) 

«  i  K  2 


No*  we  au*t  find  expressions  for  the  partial  derivatives 
with  respect  to  q  Am  before,  we  will  differentiate 
P.qs  <  4  16)  to  jet 


»4  4 


0.% 


0j  I 


r>  -  k  .  _  n  -  k  ♦  1  _  n  -  k  ♦  2 

35 - b- -"•>  '  33 - 33 - 


at>  <*>, 

o  „  _jj  _  q _ 2 


Using  the  notation 


««  have 


:  •  b  -  pC  -  qC 

r.  2  r,  ^ ..  -  1  M  r 


:  »  b  -  pC  -  qC 

k  r  k  ♦  2  r  ^  k  ♦  1  ^  r»  k  ♦  2 


-  b,  -  qC, 


<4  22) 


Becauae  C**  •  C**  -  0 .  mm  can  uw  tha  relations 


C  -  C  <k  -  n  n  1  ,  .3) 

i  l  « 


:*  -  ♦  pc3 


In  i  (ispare  F.qa  <4  21  >  and  <4  22)  With  these  transfor- 
Mtlons.  F.qa  <4  21  >  and  <4  22  >  are  the'  sasar  Therefore,  th 


partial  ilerivatlves  with  reapei  l  t«>  q  are 


o 


dq 


-C' 


-cc. 


PC3) 


We  now  have  all  that,  is  needed  to  find  the  amount  to  change 
our  guess  at  the  quadratic  factor  x2  ♦  px  ♦  q.  Eqs  (4.17) 
and  (4.18)  become 


btCp,q)  -  C2Ap  ♦  C3Aq 

bQ(p,q)  -  (Ct  -  bt4>  pC2)Ap  «■  (C2  ♦  pC3)Aq 

Solving  these  two  equations  yield  the  required  changes  in  p 
and  q.  In  this  w*y,  we  have  an  iterative  approach  to  find  a 
quadratic  factor  of  the  original  polynomial.  When  we  find 
a  quadratic  factor,  we  can  factor  it  out  and  use  the 
remaining  quotient  as  a  new  polynomial  to  examine  in  the 
same  fashion.  The  subroutine  PROOT  using  the  Bairstow 
method  (Nelsa  and  Jones,  1973:  161-163)  completes  our 
effort  to  examine  the  system's  transfer  function  H(s). 

Inverting  a  Matrix. 

The  subroutines  INVERT,  FACTOR,  and  SUBST  are  used  to 
invert  a  square  matrix.  These  subroutines  use  the  Gauss- 
Jordan  elimination  method  with  row  pivoting  to  calculate 
accurately  the  inverse  matrix.  The  details  of  this 
procedure  are  presented  below. 

The  inverse  of  a  matrix  C  is  defined  to  be  C  1 ,  such 

that 


CC  1  -  I 


(4.23) 


where  I  is  the  identity  matrix.  If  we  apply  a  series  of  row 
operations  to  the  C  matrix  on  the  left-hand  side  of  this 
equation  to  transform  C  into  I,  we  would  have  to  apply  the 
same  row  operations  to  the  right-hand  side  to  preserve  the 
equality.  This  would  give  us 

IC"1  =  C-1 

Therefore,  the  series  of  row  operations  which  transform  the 
C  matrix  into  the  identity  matrix  will  also  transform  the 
identity  matrix  into  C~*.  The  series  of  row  operations  used 
for  these  transformations  are  known  as  Gauss- Jordan 
elimination. 

Gauss- Jordan  elimination  uses  two  types  of  operations 
to  transform  a  matrix  into  a  different  Torm.  These  are 
CHornbeck,  1975:  92) 

1)  Multiplication  or  division  of  a  row  by  a  constant. 

2)  Replacement  of  any  row  by  the  sum  (or  difference) 
of  that  row  and  any  other  row. 

When  we  consider  the  elements  of  our  matrices  as 
representing  coefficients  of  linear,  independent  equations, 
we  can  see  that  these  operations  do  not  affect  the  equality 
of  Eq  <4.23). 

Therefore,  our  task  is  to  use  the  above  two  types  of 
operations  to  transform  C  into  I,  and  by  applying  the  same 
operations  on  I,  transform  I  into  C~  .  This  method  is  best 
understood  with  an  example  CHornbeck,  1975:  99).  We  will 
examine  the  3  by  3  matrix 


Writing  C  and  I  together,  we  will  perforin  our  row 
operations  on  both  matrices  at  the  same  time. 


2  11 
12  1 
112 


10  0 
0  10 


0  0  1 


To  transform  the  left  matrix  into  the  identity  matrix,  the 
first  element  must  become  1.  To  do  this,  we  divide  the 
first  row  of  both  matrices  by  2: 


1  1/2  1/2 


1/2  0 


Now  we  want  the  first  column  of  the  left  matrix  to  become 


We  can  achieve  this  by  subtracting  the  first  row  from  the 
second  row  and  replacing  the  second  row  with  this 
difference,  and  by  subtracting  the  first  row  from  the  third 
row  and  replacing  the  third  row  with  this  difference: 
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.*•  .v 


1  1/2  1/2 
0  3/2  1/2 

0  1/2  3/2 


1/2  0  0 

-1/2  1  0 


-1/2  0  1 


Here,  the  first  column  of  the  left  matrix  Is  as  we  want  it. 
Our  attention  now  shifts  to  the  second  column. 

Using  a  similar  approach,  we  want  to  transform  the 
second  element  in  the  second  column  into  1.  We  do  this  by 
dividing  the  second  row  of  both  matrices  by  the  "pivot 
element",  that  is,  the  number  which  is  the  position  where  we 
want  the  1.  Here,  the  pivot  element  is  3/2.  This  divison 
gives 


1/2  1/2 


0  1/2  3/2 


-1/3  2/3  0 

-1/2  0  1 


To  transform  the  first  element  of  the  second  column  of  the 
left  matrix  into  zero,  we  multiply  the  second  row  by  1/2, 
subtract  It  from  the  first  row,  and  replace  the  first  row 
with  this  difference.  A  similar  procedure  will  also 
transform  the  last  element  of  the  second  column  into  zero. 


1  0  1/3 

0  1  1/3 

0  0  4/3 


'  2/3  -1/3  0 

-1/3  2/3  0 

-1/3  -1/3  1 


Now  we  must  apply  this  method  to  the  last  column.  Repeating 
the  above  procedure,  we  finaly  get 
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•'•/s' ./v  /vV  *.• 


With  the  left  matrix  transformed  into  the  identity  matrix. 


the  right  matrix  is  now  C  1 .  To  verify  this,  CC  1  is 


'21  1  ' 

3/4  -1/4  -1/4  " 

1  0  0' 

12  1 

-1/4  3/4  -1/4 

- 

0  10 

!  1  2 

-1/4  -1/4  3/4 

0  0  1 

Since  C  1  is  defined  by  CC  1 «  I  ,  we  have  found  C  1 

One  computational  problem  we  can  have  with  the  Gauss- 
Jordan  elimination  method  involves  the  magnitude  of  the 
pivot  elewwnt  CHornbeck,  1975:  96>.  With  the  various 
computations  performed,  any  given  element  can  become  verv 
small  in  magnitude  compared  to  the  rest  of  the  elements  in 
its  row,  as  well  as  being  inaccurate  When  we  divide  the 
other  elewients  or  that  row  by  the  pivot  element.  we  mav 
introduce  unacceptable  roundoff  errors,  resulting  in  poor 
results.  By  interchanging  columns  of  the  matrix  so  as  to 
shift  the  largest  element  (in  magnitude)  in  the  row  of 
interest  to  the  pivot  position,  we  can  reduce  this  problem 
Every  column  Interchange  in  the  left  matrix  requires  an 
equivalent  column  interchange  in  the  right  matrix 

Utility  Routines 

NODES  requires  several  subrout  ines  which  perform 
simple,  repetitive  tasks  Classifying  these  tasks  as 
utility  routines,  we  w i 1 1  list  each  of  these  subroutines 


here,  and  briefly  discuss  their  use.  Because  they  perform 
common  tasks,  further  discussions  are  not  warranted  here. 

AXBEQC  This  is  used  to  multiply  two  matrices  (A 
times  B  equals  C) . 

DAXBEC.  This  is  a  double  precision  routine  used  to 
multiply  two  matrices. 

DIMENA.  This  asks  the  user  for  the  dimensions  of  the  A 
and  B  matrices  for  the  equation  x  -  Ax  +  Bu. 

INPUTA.  After  DIHENA  defines  the  dimensions,  this  is 
used  to  enter  the  A  and  B  matrices.  The  user  may 
either  enter  a  matrix  directly  from  the  keyboard  or 
read  a  matrix  from  an  existing  computer  file. 

PRINTA.  Used  to  print  a  real  matrix. 

PRNVFC  This  routine  prints  a  vector. 

SAVE  When  we  save  data  to  a  computer  file,  SAVE  asks 
for  the  required  information  and  saves  the  data. 

YESORN  Whenever  the  user  is  asked  a  yes  or  no 
question.  YESORN  is  used  to  retrieve  the  answer. 


Users*  Guide  to  the  Subroutines  of  MODES 

This  manual  is  a  guide  to  all  of  the  subroutines  used 
by  the  program  MODES.  The  theory  behind  these  routines  are 
presented  in  previous  chapters,  as  needed. 

Except  as  noted,  all  input  variables  to  each 
subroutine  remain  unchanged  on  output. 

In  order  to  compile  MODES  for  the  IBM  PC  compatible 
computers  using  version  3.2  of  the  Microsoft  F0RTRAN77 
compiler,  some  changes  are  required  to  bring  the  program 
within  the  memory  limits  of  the  compiler.  Specifically,  the 
matrices  must  be  dimensioned  for  10  states  instead  of  the 
current  15.  COMMON  blocks  are  also  helpful.  Specifically, 
the  10  by  10  by  10  matrices  in  RESOLV  and  POLZER,  as  well  as 
♦he  10  by  151  matrix  XHISTR  in  SIMUL8  and  PLOT  should  be 
placed  in  COMMON  blocks.  Also,  the  main  program  should  have 
H-.me  additional  subroutines  taken  from  it.  The  steps  within 
•he  Do- loop  were  selected.  Another  change,  not  required  for 
wwirv  considerations,  is  for  the  subroutine  SAVE.  The  OPEN 
.*  i»  emerit  between  lines  40  and  50  must  have  STATUS  =  "OLD". 

Mi  rnsoft  Compiler  version  3.2  does  not  recognize 
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Subroutine  ATI.Dt'F 


Purpose 

Calculates  the  closed- loop  system  Matrix  A  f  row  the 
matrices  A,  B  and  G  such  that 


A  •  A  *  BG 

A  and  B  are  defined  for  the  linear  time-invariant  state 
equation 


x  *  Ax  ♦  Bu 

and  G  is  the  feedback  gain  matrix  required  to  optimize  the 
eigenstructure,  and  therefore  the  time  response  charactei — 
istics,  of  the  modified  system 

x  *  Ax 


Calling  Sequence: 

CALL  ATLDEF  < A, B, G, ATILDE, NMAX, N, M, DIARY> 

Input  Variables: 

A  The  real  N  by  N  open-loop  system  matrix. 

B  The  real  N  by  M  input  matrix. 

G  The  real  M  by  N  feedback  gain  matrix. 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  A,  B,  G  and 
ATILDE  in  the  calling  program.  Note:  the 
original  DIMENSION  statement  for  each  of  these 


matr  i ces  must  have-  the  same  number  of  rows. 


IS 


*1 


DIARY 


Output 

ATILDE 


The  integer  number  of  rows  of  the  A  and  B 
matrices,  and  the  number  of  columns  of  the  A  and  G 
matrices  N  must  not  be  greater  than  NHAX. 

The  integer  number  of  rows  of  the  G  matrix  and  the 
number  of  columns  of  the  B  matrix.  M  must  not  be 
greater  than  N. 

The  logical  variable  indicating  if  any  WRITE 
statements  should  be  made  to  a  computer  file.  If 
DIARY  •  TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  -  FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Variables: 

The  real  N  by  N  closed-loop  matrix  X. 


Subroutine  ATRANS 


Purpose: 

Defines  the  transpose  of  a  matrix. 

Calling  Sequence: 

CALL  ATRANS  CNMAX, MMAX, N, M, A, AT) 

Input  Variables: 


NMAX 


MM  AX 


N 


M 


A 


The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  A  in  the 
calling  program. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  AT  in  the 
calling  program. 

The  integer  number  of  rows  of  the  matrix  A  and  the 
number  of  columns  of  the  matrix  AT.  N  must  not  be 
greater  than  NMAX. 

The  integer  number  of  columns  of  the  matrix  A  and 
the  number  of  rows  of  the  matrix  AT.  M  must  not 
be  greater  than  MM AX. 

The  real  N  by  M  matrix  whose  transpose  is 
to  be  found. 


Output  Variables: 

AT  The  real  M  by  N  transpose  of  the  input  matrix  A. 


Subroutine  AXBEQC 


Purpose : 

Multiplies  two  matrices  to  yield  a  third  matrix.  AB  ■  C 

Calling  Sequence: 

CALL  AXBEQC  C A, NMAXA, NA, MA, B, NMAXB, NB , MB, C, NMAXC, DIARY) 

Input  Variables: 

A  The  real  NA  by  MA  first  matrix  in  the  equation 

AB  «  C 

NMAXA  The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  A  in  the 
calling  program. 

NA  The  integer  number  of  rows  of  the  matrix  A.  NA 

must  not  be  greater  than  NMAXA. 

MA  The  integer  number  of  columns  of  the  matrix  A. 

B  The  real  NB  by  MB  matrix  in  the  equation 

AB  *  C 

NMAXB  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  B  in  the 
calling  program. 

NB  The  integer  number  of  rows  of  the  matrix  B.  NB 

must  not  be  greater  than  NMAXB. 

MB  The  integer  number  of  columns  of  the  matrix  B. 

NMAXC  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  C  in  the 
calling  program. 

The  logical  variable  indicating  if  any  WRITE 


DIARY 


statements  should  be  made  to  a  computer  file  If 
DIARY  ■  .TRUE.  then  the  VRITE  statement  will  be 
made.  If  DIARY  -  FALSE.  ,  the  VRITE  statement 
will  not  be  made. 

Output  Variables: 

C  The  real  NA  by  MB  matrix  product  of  the  matrices  A 

and  B. 


If  the  matrices  to  be  multiplied  have  incompatible  dimen¬ 
sions,  an  error  statement  is  printed. 


tj 


Subroutine  BALANC 


Purpose 


Balances  a  real  (rneral  Matrix  t.< »  prepare  the  Matrix  so  that 
a  More  accurate  calculation  of  the  Matrix  eigenstructure  ■  an 
be  Made . 


Cal line  Sequence: 


CALL  BALANC  < NM , N , A. LOW , IGH , SCALE) 


Input  Variables: 


The  integer  nuMber  of  rows  used  in  the  original 
DIMENSION  stateMent  for  the  Matrix  whose  eigen¬ 
values  are  desired,  the  Matrix  A. 

The  integer  number  of  rows  of  the  square  matrix  A. 
N  must  not  be  greater  than  NM. 

The  real  N  by  N  matrix  whose  eigenstructure  is 
desired.  On  output,  A  is  altered.  Therefore,  if 
the  original  A  matrix  will  be  needed  after  calling 
BALANC,  one  must  use  a  duplicate  matrix  in  the 
calling  statement. 


Output  Variables: 


A  The  real  N  by  N  balanced  matrix  whose  eigenvalues 

equal  the  eigenvalues  of  the  input  A  matrix. 

LOW,  IGH  Integer  variables  indicating  the  boundary  indices 
for  the  balanced  matrix.  These  variables  are  to 
be  used  by  other  eigenstructure  routines. 


inforulion  about  the  siMllanty  tranaforiMtions 


used  to  balance  the  Matrix.  SCA1.F  at  least  must 
be  of  d 1 Mens  ion  N  This  inforMation  is  to  be  used 
ahen  transforming  the  calculated  eigenvectors  of 
the  balanced  Matrix  into  the  eigenvectors  of  the 
original  Matrix. 

Assoc i a ted  Subroutines : 

BALBAK.  EIGV.  ELflHES ,  ELTRAN  and  H0R2 

References: 

1  Ssith.  B.  T.  .  et  al^.  Matrix  ElgensysteM  Rout i nes-EI SP AC1C 
Guide  Lecture  Notes  in  CoMputer  Science,  VoluMe  6 
(Second  Edition),  edited  by  3.  Goos  and  J.  Hartmanis. 

New  York:  Sprlnger-Verlag:  200-203  (1976). 

2.  Parlett,  B.N.,  and  C.  Reinsch.  "Balancing  a  Matrix  for 
Calculation  of  Eigenvalues  and  Eigenvectors, ”  Wuwerische 
MatheMatik ,  13:  293-304  (August  1969). 


Subroutine  BALBAK 


Purpose: 

Transforms  the  eigenvectors  of  a  matrix  balanced  by  the 
subroutine  BALANC  into  the  real  eigenvectors  of  the  original 
matrix.  See  subroutine  BALANC. 


Calling  Sequence: 


CALL  BALBAK  (NM , N , LOW, IGH , SCALE , M , Z> 


Input  Variables: 


NN 


N 


LOW, IGH 

SCALE 


M 

Z 


The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  Z  in  the 
calling  program. 

The  integer  equal  to  the  number  of  components  of 
the  vectors  in  the  matrix  Z.  N  must  not  be 
greater  than  NM. 

Integer  variables  indicating  the  boundary  indices 
for  the  balanced  matrix. 

A  real  one-dimensional  matrix  containing 
information  about  the  similarity  transformations 
used  to  balance  the  original  matrix.  SCALE  at 
least  must  be  of  dimension  N. 

An  integer  variable  set  equal  to  the  number  of 
columns  of  Z  to  be  back-transformed. 

A  real  two-dimensional  matrix.  The  first  M 
columns  contain  the  real  and  imaginary  parts  of 
the  eigenvectors  to  be  back-transformed. 


Output  Variables: 

Z  The  real  N  by  N  matrix  of  eigenvectors  of  the 

original  real,  general  matrix.  The  first  M 
columns  contain  the  real  and  imaginary  components 
of  the  eigenvectors.  If  the  il h  eigenvalue  is 
real,  then  the  il h  column  of  Z  contains  the 
corresponding  real  eigenvector.  If  the  il  h 
eigenvalue  is  the  first  of  a  pair  of  complex 
conjugate  eigenvalues,  then  the  il h  column  of  Z 
contains  the  real  components  of  the  associated 
complex  eigenvector,  and  the  i+1*1  column  contains 
the  imaginary  components  of  this  eigenvector. 

Associated  Subroutines: 


BALANC,  EIGV,  ELMHES,  ELTRAN  and  HQR2 


References: 


1.  Smith,  B. T. ,  et  al..  Matrix  Eigensystem  Routines-EISPACK 
Guide.  Lecture  Notes  in  Computer  Science,  Volume  6 
(Second  Edition),  edited  by  G.  Goos  and  J.  Hartmanis. 

New  York:  Springer-Verlag:  200-203  (1976). 

2.  Parlett,  B.N.,  and  C.  Reinsch.  "Balancing  a  Matrix  for 
Calculation  of  Eigenvalues  and  Eigenvectors, "  Numerische 
Mathematik,  13:  293-304  (August  1969). 


A 


Subroutine  COPYAB 


Purpose: 

Copies  one  matrix.  A,  and  names  the  duplicate  matrix  B. 

Calling  Sequence: 

CALL  COPYAB  CNMAX, N, M, A, B> 

Input  Variables: 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  A  and  B  in 
the  calling  program.  The  original  DIMENSION 
statement  for  both  matrices  must  have  the  same 
number  of  rows. 

N  The  integer  number  of  rows  of  the  matrices  A  and 

B. 

M  The  integer  number  of  columns  of  the  matrices  A 

and  B. 

A  The  real  N  by  M  matrix  to  be  copied. 

Output  Variables: 

B  The  real  N  by  M  matrix  which  equals  the  input 

matrix  A. 


Subroutine  DAXBEC 


Purpose : 

Multiplies  two  matrices  to  yield  a  third  matrix  AB  *  C 
DAXBEC  is  the  DOUBLE  PRECISION  equivalent  of  the  subroutine 
AXBEQC. 


Calling  Sequence : 

CALL  DAXBEC  C A, NMAXA. NA, MA, B , NMAXB . NB , MB . C , NMAXC . DI ARY ) 

Input  Variables: 

A  The  real  NA  by  MA  first  matrix  in  the 

equation  AB  *  C 

NMAXA  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  A  in  the 
calling  program. 

NA  The  integer  number  of  rows  of  the  matrix  A.  NA 

must  not  be  greater  than  NMAXA.  Also,  NA  must  not 
be  greater  than  NMAXC. 

MA  The  integer  number  of  columns  of  the  matrix  A. 

B  The  real  NB  by  NB  matrix  in  the  equation 

AB  =  C 

NMAXB  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  B  in  the 
calling  program. 

NB  The  integer  number  of  rows  of  the  matrix  B.  NB 

must  not  be  greater  than  NMAXB. 

MB  The  integer  number  of  columns  of  the  matrix  B. 

The  integer  number  of  rows  used  in  the  original 


NMAXC 


DIMENSION  stdt.e«*‘nt  for  t  tic  mat  t  i  \  ('  in  •  he 
calling  program 

DIARY  The  logical  variable  indicating  if  anv  VR I TF 

s’  atement.s  should  be  made  t.o  a  computer  file  If 
DIARY  *  TRUE  t.hen  t  he  WRITE  st  at ement  will  fu¬ 
made  If  DIARY  *  FAl.SE  the  WRITE  statement 

will  not  be  made 

Output  Var 1 ab les : 

C  The  real  NA  bv  MB  product  of  the  matrices  A 

and  B 


If  the  matrices  to  be  multiplied  have  incompatible  dimen¬ 
sions,  an  error  statement  is  printed. 


Subroutine  DIMENA 


Purpose 

Asks  the  user  for  the  dimensions  of  a  two-dimensional  matrix 

which  is  to  be  defined. 

Ca 1 1 1 ng  Sequence : 

Gall  DIMENA  (N,M, DIARY) 

I nput  Variables: 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  *  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  »  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variab i ?s: 

N  The  integer  number  of  rows  of  the  matrix  to  be 

defined. 

M  The  integer  number  of  columns  of  the  matrix  to  be 

defined. 

Subroutines  Called: 


YESORN 
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Subroutine  EIGSTR 


Purpose: 

Asks  the  user  for  the  desired  eigenvalues  and  eigenvectors, 
and  defines  the  desired  eigenstructure  matrices  from  that 
information. 

Calling  Sequence: 

CALL  EIGSTR  CEVEC, EVAL, NMX2 , N, DIARY) 

Input  Variables: 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  EVAL  in  the 
calling  program.  Also  the  dimension  used  in  the 
original  DIMENSION  statement  for  the  one-dimen¬ 
sional  matrix  EVAL.  NMX2  must  be  at  least  twice 
the  number  of  eigenvalues  to  be  defined. 

The  integer  number  of  eigenvalues  to  be  defined. 
The  logical  variable  indicating  if  any  WRITE 
statements  should  be  made  to  a  computer  file.  If 
DIARY  ■  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variables: 

EVEG  The  real  2N  by  N  matrix  of  eigenvectors.  The 

eigenvectors  are  stored  in  the  columns  of  EVEC. 
The  first  N  elements  of  any  column  are  the  real 


NMX2 


N 

DIARY 


components  of  the  eigenvector;  the  second  N 
elements  of  any  column  are  the  imaginary 
components. 


V, 


EVAL  The  real  2N  by  1  matrix  of  eigenvalues.  The  il h 

element  Ci<N)  is  the  real  component  of  the  il  h 
eigenvalue;  the  i+Nl  h  element  is  the  imaginary 
component.  The  il h  eigenvalue  is  associated  with 

the  eigenvector  in  the  il h  column  of  EVEC. 
Subroutines  Used; 


YESORN 


Subroutine  EIGV 


Purpose: 

Calculates  the  eigenvalues  and  eigenvectors  of  a  general, 

real  matrix. 

Calling  Sequence: 

CALL  EIGV  <A,Z, VR, VI, NMAX, N, DIARY) 

Input  Variables: 

A  The  real  N  by  N  matrix  whose  eigenstructure  is 

desired.  Restriction  on  N:  N<NMAX<15. 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  A  and  Z  in 
the  calling  program.  The  original  DIMENSION 
statements  for  both  A  and  Z  must  have  the  same 
number  of  rows.  Restriction  on  NMAX:  NMAX<15. 

N  The  integer  number  of  rows  of  the  square  matrices 

A  and  Z.  Also,  the  number  of  elements  in  the 
one-dimensional  vectors  WR  and  VI.  N  must  not  be 
greater  than  NMAX. 

DIARY  The  logical  variable  indicating  if  any  VRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  VRITE  statement  will  be 
made.  If  DIARY  ■  . FALSE.  ,  the  VRITE  statement 
will  not  be  made. 


Output  Variables: 


The  real  N  by  N  matrix  of  eigenvectors.  When  the 


il h  eigenvalue  is  real  CWICi)=0)  ,  the  ilh 
column  contains  the  components  of  the  associated 
real  eigenvector.  When  the  il h  eigenvalue  is  the 
first  of  a  pair  of  complex  conjugate 
eigenvalues,  the  il h  column  contains  the 
real  components  of  the  associated  complex 
eigenvector;  the  i+lst  column  contains 
the  imaginary  components. 

The  real  vector,  of  dimension  N,  containing  the 
real  components  of  the  eigenvalues  of  the  matrix 

A.  The  il h  eigenvalue  corresponds  to  the  ith 
eigenvector  in  Z. 

The  real  vector,  of  dimension  N,  containing  the 
imaginary  components  of  the  eigenvalues  of  matrix 
A.  The  il h  eigenvalue  corresponds  to  the  ilh 
eigenvector  in  Z. 


Subroutines  Used: 


BALANC,  BALBAK,  COPYAB,  ELMHES,  ELTRAN,  and  HQR2 
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Subroutine  ELMHES 


Purpose: 

Reduces  a  real,  general  matrix  to  upper  Hessenberg  form  so 
that  subroutine  HQR2  can  calculate  the  eigenstruture  of  the 
original  matrix. 

Calling  Sequence: 

CALL  ELMHES  <NM, N, LOW, IGH, A, INT> 


Input  Variables: 


NM 


N 

LOW, IGH 


A 


The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  A  in  the 
calling  program. 

The  integer  number  of  rows  of  the  square  matrix 
A.  N  must  not  be  greater  than  NM. 

The  integer  variables  indicating  the  boundary 
indices  for  the  balanced  matrix.  If  the  matrix  is 
not  balanced,  set  L0W=1  and  IGH=N.  See  subroutine 
BALANC. 

The  real  N  by  N  matrix  to  be  transformed  to  upper 
Hessenberg  form. 


Output  Variables: 

A  The  upper  Hessenberg  matrix  and  the  multipliers 

used  to  perform  the  reduction. 

INT  An  integer  one-dimensional  variable  of  dimension 

at  least  IGH  which  identifies  the  rows  and  columns 
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interchanged  during  the  reduction. 


Associated  Subroutines: 

BALANC,  B ALB AtC,  EIGV,  ELTRAN  and  HQR2 

References: 


1.  Smith,  B.T.  ,  et  a_l.  Matrix  Eigensystem  Routines-EISPACK 
Guide.  Lecture  Notes  in  Computer  Science,  Volume  6 
(Second  Edition),  edited  by  G.  Goos  and  J.  Hartmanis. 

New  York:  Springer-Verlag:  200-203  (1976). 

2.  Martin,  R.S. ,  and  J. H.  Wilkinson.  "Similarity  Reduction 
of  a  General  Matrix  to  Hessenberg  Form, "  Numerische 
Mathematik,  12:  349-368  (December  1968). 

* 


Subroutine  ELTRAN 


Purpose: 

Accumulates  the  similarity  transformations  used  in  the 
reduction  of  a  real  general  matrix  to  upper  Hessenberg  form 
by  ELMHES. 

Calling  Sequence: 

CALL  ELTRAN  CNM, N, LOW, IGH, A, INT, Z) 


Input  Variables: 


NM 


N 

LOW, IGH 


A 


INT 


The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrices  A  and  Z  in 
the  calling  program.  The  original  DIMENSION 
statements  for  both  A  and  Z  must  have  the  same 
number  of  rows. 

The  integer  number  of  rows  of  the  square  matrix  A. 
N  must  not  be  greater  than  NM. 

The  integer  input  variables  indicating  the 
boundary  indices  for  the  balanced  matrix.  If  the 
matrix  is  not  balanced,  set  L0W«1  and  IGH=N. 

The  real  two-dimensional  matrix  containing  the 
multipliers  which  were  used  in  the  reduction  to 
the  Hessenberg  form  in  its  lower  triangle  below 
the  subdiagonal. 

The  one-dimensional  integer  variables  identifying 
the  rows  and  columns  interchanged  during  the 
reduction  by  ELMHES. 
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Output  Variables: 


Z  The  real  two-dimensional  transformation  matrix 

produced  in  the  reduction  to  the  upper  Hessenberg 
form  by  ELMHES. 

Associated  Subroutines: 

BALANC,  BALBAK,  EIGV,  ELMHES,  and  HQR2 

References: 


1.  Smith,  B.T.  ,  et  al..  Matrix  Eigensystem  Routines-EISPACK 
Guide.  Lecture  Notes  in  Computer  Science,  Volume  6 
(Second  Edition),  edited  by  G.  Goos  and  J.  Hartmanis. 

New  York:  Springer-Verlag:  200-203  C1976). 

2.  Peters,  G. ,  and  J.H.  Wilkinson.  "Eigenvectors  of  Real 
and  Complex  Matrices  By  LR  and  QR  Triangularizations, " 
Numerische  Mathematik,  16:  181-204  C1970). 


Subroutine  FACTOR 


Purpose: 


Performs  a  factorization  of  a  square  matrix  as  the  first 
step  of  the  Gauss-Jordan  elimination  method  to  calculate  the 
inverse  of  a  matrix. 


Calling  Sequence: 


CALL  FACTOR  CA, V, IPIVOT, D, N, IFLAG, NM> 


Input  Variables: 


The  real  N  by  N  matrix  to  be  inverted. 

A  real  N  by  N  working  array. 

The  integer  number  of  rows  for  both  square 
matrices  A  and  V. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrices  A  and  V.  The 
original  DIMENSION  statement  for  both  matrices 
must  have  the  same  number  of  rows. 


Output  Variables: 


W  The  real  N  by  N  working  array. 

IPIVOT  The  integer  vector  of  dimension  N  identifying  the 
pivot  elements  for  the  Gauss-Jordan  elimination. 

D  The  real  vector  of  dimension  N  storing  the 

absolute  value  of  the  element  of  each  row  of  the 
matrix  A  which  has  the  largest  magnitude  of  all 
elements  in  that  row. 
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IFLAG  The  integer  variable  used  to  identify  when  the  A 

matrix  is  singular. 

Associated  Subroutines: 

INVERT  and  SUBST 

Subroutine  HQR2 

Purpose: 

Computes  the  eigenvalues  and  eigenvectors  of  a  real  upper 
Hessenberg  matrix  using  the  QR  method. 

Calling  Sequence: 

CALL  HQR2  <NM, N , LOW, IGH, H, VR, VI ,Z, IERR) 

Input  Variables: 


NM  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  H  and  Z.  The 
original  DIMENSION  statement  for  both  matrices 
must  have  the  same  number  of  rows. 

N  The  number  of  rows  in  both  square  matrices  A  and 

Z.  N  must  not  be  greater  than  NM. 

LOW, IGH  The  integer  variables  indicating  the  boundary 

indices  for  the  balanced  matrix.  If  the  matrix  is 
not  balanced,  set  LOW*!  and  IGH=N. 

H  The  real  N  by  N  upper  Hessenberg  matrix.  Note: 

HQR2  destroys  this  matrix  on  output. 

Z  If  the  eigenvectors  of  the  upper  Hessenberg  matrix 


are  desired,  Z  contains  the  identity  matrix  of 
order  N.  If  the  eigenvectors  of  a  real  general 
matrix  are  desired,  then  Z  is  the  transformation 
matrix  produced  in  ELTRAN  which  reduced  the 
general  matrix  to  Hessenberg  form. 

Output  Variables: 

VR  The  real  one-dimensional  array  of  dimension  N 

containing  the  real  parts  of  the  eigenvalues. 

VI  The  real  one-dimensional  array  of  dimension  N 

containing  the  imaginary  parts  of  the  eigenvalues. 

Z  The  real  N  by  N  matrix  of  eigenvectors.  If  the 

il h  eigenvalue  is  real,  then  the  il h  column  of  Z 
contains  the  associated  eigenvector.  If  the  il h 
eigenvalue  is  the  first  of  a  pair  of  complex 
conjugate  eigenvalues,  then  the  il h  column  of  Z 
is  the  real  part  of  the  associated  complex  eigen¬ 
vector,  and  the  i+lsl  column  is  the  imaginary  part 
of  this  eigenvector. 

IERR  The  integer  error  code.  If  IERR=0  then  HQR2  has 

converged  to  an  answer.  If  IERR^^O,  then  HQR2  has 
not  converged. 

Associated  Subroutines: 

BALANC,  BALBAK,  EIGV,  ELMHES,  ELTRAN 
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Subroutine  INPUTA 


Purpose: 

Reads  any  real  two-dimensional  array  from  either  the 

keyboard  or  from  an  existing  computer  file. 

Galling  Sequence: 

CALL  INPUTA  CNMAX, N, M, A, DIARY> 

Input  Variables: 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  A. 

N  The  integer  number  of  rows  of  the  matrix  A.  N 

must  not  be  greater  than  NMAX. 

M  The  integer  number  of  columns  of  the  matrix  B. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variables: 

A  The  real  N  by  M  matrix  to  be  entered. 

Subroutines  Used: 


YESORN 


Subroutine  INVERT 


Purpose: 


Inverts  a  real,  square  matrix. 


Cal line  Sequence: 


CALL  INVERT  < A, AINV, N, DIARY) 


Input  Variables: 


A  The  real  N  by  N  matrix  to  be  inverted. 

N  The  integer  number  of  rows  of  the  matrix  A. 

Restriction  on  N:  N<15. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  53  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 


Output  Variables: 


AINV  The  real  N  by  N  matrix  which  is  the  inverse  of  the 

matrix  A. 


If  the  matrix  to  be  inverted  is  singular,  an  error  message 
is  printed. 


Subroutines  Used: 


FACTOR  and  SUBST. 


Subroutine  PACHDF 


Purpose: 

Defines  the  matrix  of  optimal  eigenvectors  and  the 

product  of  the  feedback  gain  matrix  and  the  optimal 

eigenvectors,  Gp^. 

Calling  Sequence: 

CALL  PACHDF  CPA, PACH, NMAX, N, M, K> 

Input  Variables: 

PA  The  real  N  by  1  array  containing  the  vector  po  in 

the  first  2n  elements,  and  the  vector  Gpo  in  the 
last  2m  elements.  Here,  n  is  the  number  of  rows 
of  the  square  matrix  A,  and  m  is  the  number  of 
columns  in  the  input  matrix  B  for  x  =  Ax  +  Bu 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  arrays  PA  and  PACH  in 
the  calling  program.  Note:  the  original 
DIMENSION  statement  for  both  PA  and  PACH  must  have 
the  same  number  of  rows. 

N  The  integer  number  of  rows  of  the  array  PACH,  and 

the  number  of  elements  in  the  one-dimensional 
array  PA.  Where  n  and  m  are  defined  as  in  the 
discussion  of  PA  above,  N  =  2Cn+m>  N  must  not 

be  greater  than  NMAX. 

M  The  integer  number  of  rows  of  the  array  PACH. 

Where  n  and  m  are  defined  as  in  the  discussion  of 


PA  above,  M  ■  m 

K.  The  integer  identifying  which  column  of  PACH  is 

to  receive  the  input  data  in  PA. 

Output  Variables: 

PACH  The  real  N  by  M  array  containing  all  defined 

optimal  vectors  pQ  in  the  first  2n  rows,  and  the 
vectors  Gjp^  in  the  last  2m  elements.  Here,  n  and 


m  are  defined  as  in  the  discussion  of  PA  above. 


Subroutine  PDDEF 


Purpose: 

Defines  the  desired  one-dimensional  eigenvector  array  from 

the  two-dimensional  array  containing  all  desired  eigen¬ 
vectors. 

Calling  Sequence: 

CALL  PDDEF  CEVEC, PD, NMAX, N, M, K) 

Input  Variables: 

EVEC  The  real  N  by  H  array  containing  all  of  the 

desired  eigenvectors. 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  arrays  EVEC  and  PD  in 
the  calling  program.  Note:  the  original 
DIMENSION  statement  for  both  arrays  must  have  the 
same  number  of  rows. 

N  The  integer  number  of  rows  of  the  array  EVEC,  and 

the  number  of  elements  of  the  aray  PA.  N  must  not 
be  greater  than  NMAX. 

M  The  integer  number  of  columns  of  the  array  EVEC. 

K.  The  integer  index  defining  which  column  of  EVEC 

will  be  used  to  define  PD. 


Output  Variables: 


PD  The  real  N  by  i  array  containing  a  desired 

eigenvector. 
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Subroutine  PLOT 


Plots  the  discrete  time  response  history  of  a  system. 

Galling  Sequence: 

GALL  PLOT  (XHISTR, RP1 ,  N,  T, DIARY) 

Input  Variables: 

XHISTR  The  real  N  by  KP1  array  containing  the  time 

history  information  of  the  system.  The  il h  row 

contains  the  information  for  the  il h  element  of 
the  state  vector. 

KP1  The  integer  number  of  columns  of  the  array  XHISTR. 

Also,  the  number  of  discrete  points  used  to 
describe  the  time  response  history  of  each  state. 

N  The  integer  number  of  rows  of  the  array  XHISTR. 

Also,  the  number  of  elements  in  the  state  vector 
used  to  generate  XHISTR.  Restriction  on  N:  N<15. 

T  The  real  time  increment  used  to  discretize  the 

system  time  response  history. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  »  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  *  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variables: 

None. 
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The  time  response  history  is  plotted  on  the  terminal  screen 


Subroutine  PNRDEF 


Purpose: 

Defines  the  matrices  P  and  R  to  be  used  to  find  the  required 
feedback  gain  matrix. 

Calling  Statement: 

CALL  PNRDEF  (PACH, P, R, NMAXPA, NMAXP, NMAXR, N, M, EFFECO , DIARY) 


Input  Variables: 


PACH 


NMAXPA, 

NMAXP, 

NMAXR 


The  real  2CN+M)  by  N  array  containing  the  matrix  P 
in  the  first  2N  rows,  and  the  matrix  R  in  the  last 
2M  rows. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  arrays  PACH,  P  and  R, 
respectively,  in  the  calling  program. 

Restrictions:  NMAXPA<15  ;  NMAXP<15  ; 

NMAXR<15 


N 

M 

EFFECO 


DIARY 


The  integer  number  of  rows  and  columns  in  the 
array  P. 

The  integer  number  of  rows  in  the  array  R. 

The  real  number  used  as  the  tolerance,  or  the 
effective  value  of  zero.  If  the  sum  of  the 
absolute  value  of  the  imaginary  components  of  a 
vector  is  less  than  EFFECO,  the  vector  is  assumed 
to  be  real. 

The  logical  variable  indicating  if  any  WRITE 
statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 


made.  If  DIARY 


.  FALSE. 


the  WRITE  statement 


will  not  be  made. 

Output  Variables: 

P  The  real  N  by  N  array  of  optimal  eigenvectors. 

R  The  real  M  by  N  array  used  with  P  to  find  the 

required  feedback  gain  matrix. 


Subroutine  POLZER 


Purpose: 


Prints  the  resolvent  matrix  and  the  poles  and  zeroes  of  the 
resolvent  matrix. 


Gal line  Sequence: 


CALL  POLZER  < A,  N, DIARY) 


Input  Variables: 


The  real  N  by  N  matrix,  in  the  time  domain,  for 
which  the  resolvent  matrix  and  poles  and  zeroes 
are  wanted. 

The  integer  number  of  rows  in  the  square  A  matrix. 
Restriction  on  N:  N<15 

The  logical  variable  indicating  if  any  WRITE 
statements  should  be  made  to  a  computer  file.  If 
DIARY  =*  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 


DIARY 


Output  Variables: 


None 


The  resolvent  matrix  and  poles  and  zeroes  are  printed  on  the 
terminal . 
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Subroutine  PRINTA 

Purpose : 

Prints  a  real  matrix. 

Calling  Sequence: 

CALL  PRINTA  CNMAX, N, M, A, DIARY) 

Input  Variables: 

NMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrix  A  in  the 
calling  program. 

N  The  integer  number  of  rows  in  the  matrix  A. 

M  The  integer  number  of  columns  in  the  matrix  A. 

A  The  real  N  by  M  matrix  to  be  printed. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  *  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variables: 

None 
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Subroutine  PRINTZ 


Purpose: 


Prints  the  eigenstructure  of  a  matrix  as  found  by 
subroutines  BALANC,  BALBAK,  EIGV,  ELMHES,  ELTRAN,  and  HQR2. 


Calling:  Sequence: 


CALL  PRINTZ  <Z, VR , VI , NMAX , N , DIARY) 


Input  Variables: 


The  real  N  by  N  matrix  of  eigenvectors.  If  the 
il h  eigenvalue  is  real,  the  il h  column  of  Z  is  the 
associated  eigenvector.  If  the  il h  eigenvalue  is 
the  first  of  a  pair  of  complex  conjugate  eigen¬ 
values,  the  il h  column  of  Z  contains  the  real 
components  of  the  associated  eigenvector  and  the 
i+1  column  contains  the  imaginary  components. 

The  real  N  by  1  arrays  containing  the  real  and 
imaginary  components  of  the  eigenvalues,  respec¬ 
tively.  The  iLh  elements  in  the  arrays  correspond 
to  the  il h  eigenvector  in  Z.  Complex  conjugate 
eigenvalues  are  stored  adjacent  to  each  other. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  arrays  Z,  VR,  and  VI 
in  the  calling  program.  Note:  the  original 
DIMENSION  statements  for  each  of  these  arrays  must 
have  the  same  number  of  rows. 

The  integer  number  of  rows  of  the  Z,  VR,  and  VI 
arrays.  N  must  not  be  greater  than  NMAX. 


VR,  VI 


NMAX 


DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

Output  Variables: 

None 

Subroutines  Used: 

PRINTA,  PRNVEC 


t 
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Subroutine  PRNVEC 


Purpose: 

Prints  a  one-dimensional  vector. 

Calling  Sequence: 

CALL  PRNVEC  <S, NMAX, N, DIARY) 

Input  Variables: 

S  The  real  N  by  1  vector  to  be  printed. 

NMAX  The  integer  number  of  elements  used  in  the 

original  DIMENSION  statement  for  the  vector  S. 

N  The  integer  number  of  elements  of  the  vector  S. 

DIARY  The  logical  variable  indicating  if  any  VRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  »  .TRUE.  then  the  VRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  VRITE  statement 
will  not  be  made. 

Output  Variables: 


None 


Subroutine  PROOT 


Purpose: 

Finds  the  roots  of  a  polynomial  with  real  coefficients, 
using  a  modified  Bairstow  method. 

Calling  Sequence: 

CALL  PROOT  (N, A, U, V, IR) 

Input  Variables: 

N  The  integer  degree  of  the  polynomial. 

Restriction:  N<15 

A  The  real  N+l  by  1  array  of  the  polynomial 

coefficients. 

IR  The  integer  indicating  how  the  array  A  is  written 

If  IR  =  +1  ,  the  polynomial  is  written  as 

ACl)  +  A(2)x  +  AC3>x2  +  ...+  ACN+1)xN 

If  IR  =  -1  ,  the  polynomial  is  written  as 

AC1)xN  +  A(2)xCN_l3+. . . +  ACPOx  +  ACN+1) 


Output  Variables: 

U  The  real  N+l  by  1  array  containing  the  real 

components  of  the  roots  of  the  polynomial. 

V  The  real  N+l  by  1  array  containing  the  imaginary 


components  of  the  roots  of  the  polynomial. 


Reference: 

Melsa,  James  L. ,  and  Stephen  K.  Jones.  Computer  Programs 
for  Computational  Assistance  in  the  Study  of  Linear  Control 
Theory  (Second  Edition),  pp  161-163.  New  York:  McGraw-Hill 
Book  Company,  1973. 


Subroutine  RESOLV 


Purpose: 


Calculates  the  resolvent  matrix  in  the  form 


t  sI-A]  1  = 


Q<s) 

ACs) 


Uses  the  Leverrier  or  Faddeev  recursion. 


Cal  line:  Seauence: 


CALL  RESOLV  ( AR, POLESR, QR, N , CHECK, DIARY > 


Input  Variables: 


AR  The  real  N  by  N  matrix  from  which  the  resolvent 

matrix  is  to  be  defined. 

N  The  integer  number  of  rows  in  the  square  matrix 

AR.  Restriction:  N<15 

CHECK  The  logical  variable  used  to  indicate  if  a  check 

of  the  accuracy  of  the  subroutine  results  is  to  be 
printed.  If  CHECK  =  .TRUE.  ,  the  check  will  be 
performed  and  printed.  If  CHECK  =  .FALSE.  ,  the 
check  is  not  performed. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =*  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 
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Output  Variables: 

POLESR  The  real  N  by  1  array  containing  the  coefficients 
of  the  characteristic  equation.  The  character — 
istic  equation  is  written  as 

ACs)  =  sN+  POLESRCN)sn_1+. . . +  P0LESRC2)s  +  POLESR(l) 

QR  The  real  N  by  N  by  N  array  containing  the 

coefficients  of  the  N2  polynomials  of  the 
numerator  Q<s>.  The  numerator  polynomials  are 
written  as 

QCs)  =  QCI,  J,N)scn"°  +  QCI,  J,  N— l>sCN~2) 

+. . .+  QC I , J, 2)s  +  QCI , J, 1) 

The  I,J  terms  refer  to  the  polynomial  in  the  I,J 
location  of  the  resolvent  matrix  numerator. 

Subroutine  Used: 

DAXBEC 

Reference: 

Reid,  J.  Gary.  Linear  System  Fundamentals  Continuous  and 
Discrete,  Classic  and  Modern,  pp  449,  450.  New  York: 
McGraw-Hill  Book  Company,  1983. 


Saves  data  to  a  computer  file. 

Calling  Sequence: 

CALL  SAVE  <A, B,C,N,M, DIARY, FILED, ITEST> 
Input  Variables: 


A 

The 

real 

N 

by 

M 

matrix 

to 

be 

saved . 

B 

The 

real 

N 

by 

M 

matrix 

to 

be 

saved . 

C 

The 

real 

N 

by 

1 

matrix 

to 

be 

saved. 

N  The  integer  number  of  rows  of  the  matrix  to  be 

saved.  Restriction:  If  ITEST  *>  1  N<15  ;  If 

ITEST  >  1  ,  N<30  . 

M  The  integer  number  of  columns  of  the  matrix  to  be 

saved. 

DIARY  The  logical  variable  indicating  if  any  WRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 

FILED  The  character  variable  containing  the  name  of  the 

DIARY  computer  file. 

ITEST  The  integer  indicating  which  matrix  is  to  be 

saved.  If  ITEST  =1  ,  A  is  saved.  B  is  saved 

if  ITEST  =  2  .  If  ITEST  =3  ,  C  is  saved. 


v\ 


Subroutine  SETUPC 


Purpose: 

Defines  the  transpose  of  the  augmented  matrix  [A-X  I,B1, 

for  complex  eigenvalues  Xl ,  to  be  entered  in  subroutine  SVD. 

Calling  Sequence: 

CALL  SETUPC  < A, B, EVALR, EVALI , SETUP, N , M, NX2) 

Input  Variables: 

A  The  real  N  by  N  system  matrix  used  in  the 

augmented  matrix. 

B  The  real  N  by  M  input  matrix  used  in  the  augmented 

matrix. 

EVALR  The  real  variable  representing  the  real  component 

of  the  eigenvalue  X^ . 

EVALI  The  real  variable  representing  the  imaginary 

component  of  the  eigenvalue  X  . 

N  The  integer  number  of  rows  in  the  square  system 

matrix  A. 

M  The  integer  number  of  columns  in  the  input  matrix 

B. 

NX2  The  integer  variable  equal  to  2  times  N. 

NX2  =  N  x  2 

Output  Variables: 


SETUP 


The  real  2N  by  2CN+M)  transpose  of  the  augmented 
matrix. 


Subroutine  Used 


ATRANS 
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Subroutine  SIGPL 


Purpose: 


Defines  the  matrix  SIGPLS  +  )  from  the  vector  of  ordered 

singular  values. 

Calling  Sequence: 

CALL  SIGPL  CS, SIGPLS, NMAXS, NMAXSP, N, M, EFFECO> 


Input  Variables: 


S 


NMAXS 

NMAXSP 

N 


M 

EFFECO 


The  real  N  by  1  vector  of  singular  values.  The 
singular  values  are  stored  in  decreasing  order  of 
magnitude. 

The  integer  number  of  elements  used  in  the 
original  DIMENSION  statement  for  the  vector  S. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  SIGPLS. 

The  integer  number  of  elements  in  the  vector  S, 
and  the  number  of  columns  in  the  matrix  SIGPLS. 
Restrictions:  N<NMAXS 

The  integer  number  of  rows  of  the  matrix  SIGPLS. 
Restriction:  M<NMAXSP 

The  real  variables  used  as  the  tolerance,  or  the 
effective  zero. 


Output  Variable: 


SIGPLS 


The  M  by  N  matrix  I*. 


Subroutine  SIMUL8 


Purpose: 

Simulates  the  time  response  history  of  a  controlled  system. 

Calculates  the  time  response  history  matrix  which  is  plotted 

with  subroutine  PLOT. 

Calling  Sequence: 

CALL  SIMUL8  (A, B, N, M, DIARY) 

Input  Variables: 

A  The  real  N  by  N  system  matrix  used  for  the  time 

history  simulation. 

B  The  real  N  by  M  input  matrix  used  for  the  time 

history  simulation. 

N  The  integer  number  of  rows  of  the  square  system 

matrix  A,  and  the  number  of  rows  of  the  input 
matrix  B.  Restrictions:  N<15 

M  The  integer  number  of  columns  of  the  input  matrix 

B.  Restrictions:  M<15 

DIARY  The  logical  variable  indicating  if  any  VRITE 

statements  should  be  made  to  a  computer  file.  If 
DIARY  ■  .TRUE.  then  the  VRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  VRITE  statement 
will  not  be  made. 


Output  Variables: 


Subroutine  SUBST 


Purpose: 

Solves  for  the  inverse  of  a  square  matrix  after  tho 
subroutine  FACTOR  factors  the  original  matrix  into  a  suit¬ 
able  form.  Solves  for  only  one  column  of  the  inverse  matrix 
per  call. 


Calling  Sequence: 


CALL  SUBST  C  V,  B,  X, IPIVOT, N, NMAX) 


Input  Variables: 


W 


B 


IPIVOT 

N 

NMAX 


The  real  N  by  N  matrix  which  has  been  factored  by 
the  subroutine  FACTOR.  Before  being  entered  to 
FACTOR,  this  was  the  matrix  to  be  inverted. 

A  real  N  by  1  working  array.  All  elements  of  B 
equal  0,  except  BCJ),  where  J  is  the  number  of 
the  column  of  the  inverse  matrix  to  be  defined. 

An  integer  N  by  1  working  array. 

The  integer  number  of  rows  in  the  square  inverse 
matrix. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  V  in  the 
calling  program. 


Output  Variable: 

The  real  N  by  1  column  of  the  inverted  matrix 
found.  Where  BCJ)  =1  ,  X  is  the  Jl h  column  of 


X 


Subroutine  SVD 


Purpose: 

Calculates  the  singular  value  decomposition  of  a  real 

matrix. 

Calling  Sequence: 

CALL  SVD  <A,MMAX,NMAX,M,N,NU,NV,S,U,V,IER> 

Input  Variables: 

A  The  real  M  by  N  matrix  for  which  the  singular 

value  decomposition  is  desired. 

MMAX  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  A  and  U  in 
the  calling  program.  The  original  DIMENSION 
statement  for  both  matrices  must  have  the  same 
number  of  rows. 

M  The  integer  number  of  rows  of  the  matrix  A. 

N  The  integer  number  of  columns  of  the  matrix  A. 

Restrictions:  N<M 

NU  The  integer  number  of  columns  to  be  calculated  for 

the  M  by  M  matrix  U.  The  only  values  permitted 
are  0,  N,  or  M. 

NV  The  integer  number  of  columns  to  be  calculated  for 

the  N  by  N  matrix  V.  The  only  values  permitted 


Output  Variables: 

S  The  real  N  by  1  vector  of  singular  values.  These 

singular  values  are  sorted  in  decreasing  order  of 
magnitude. 

U  The  real  N  by  N  matrix  of  the  orthonormal  eigen¬ 

vectors  of  the  matrix  AAT. 

V  The  real  M  by  M  matrix  of  the  orthonormal  eigen¬ 

vectors  of  the  matrix  ATA. 

IER  The  integer  indicating  when  SVD  has  not  converged 

to  a  singular  value  within  30  iterations.  If 
IER=9999  ,  SVD  has  not  converged.  If  IER<9999  , 

SVD  has  converged. 

Reference: 

Businger,  Peter  A. ,  and  Gene  H.  Golub.  "Algorithm  358: 

Singular  Value  Decomposition  of  a  Complex  Matrix,"  Collected 

Algorithms  From  ACM,  Vol.  2,  Book  1.  New  York:  The 

Association  for  Computing  Machinery,  Inc.,  1980. 


Subroutine  V2DEF 


Purpose: 


Determines  the  null  space  matrix  V2  given  the  matrix  V  and 
the  ordered  singular  values.  V  is  found  from  the  singular 
decomposition  of  a  source  matrix  A. 


Calling  Sequence: 


CALL  V2DEF  < V, NMV, N, S, NMS, V2 , NV2 , EFFEO , DIARY) 


Input  Variables: 


V  The  real  N  by  N  matrix  of  the  orthornormal  eigen¬ 

vectors  of  a  matrix  ATA,  where  the  source  matrix  A 
has  N  rows. 

NMV  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  matrices  V  and  V2  in 
the  calling  program. 

N  The  integer  number  of  rows  in  the  matrices  V  and 

V2,  and  the  number  of  elements  in  the  vector  S. 
Restrictions:  N<NMV  ;  N<NMS  ;  N<NV2  . 

S  The  N  by  1  array  containing  the  ordered  vector  of 

singular  values.  The  singular  values  are  stored 
in  descending  order  of  magnitude. 

NMS  The  integer  number  of  rows  used  in  the  original 

DIMENSION  statement  for  the  vector  S  in  the 
calling  program. 

EFFECO  The  real  variable  used  as  the  tolerance,  or  the 
effective  zero. 

DIARY  The  logical  variable  indicating  if  any  WRITE 
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statements  should  be  made  to  a  computer  file.  If 
DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 
made.  If  DIARY  =  .FALSE.  ,  the  WRITE  statement 
will  not  be  made. 


Output  Variables: 


R 


S' 


& 


V2 


NV2 


The  real  N  by  MV2  matrix  defining  the  null  space 
of  the  source  matrix  A. 

The  integer  number  of  columns  of  the  matrix  V2. 
Also,  the  rank  of  the  source  matrix  A. 
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Subroutine  V2SDEF 


Purpose: 

Defines  the  matrix  V2S  from  the  first  rows  of  the  null  space 
matrix  V2.  V2S  defines  the  range  space  of  achievable  eigen¬ 
vectors  for  MODES.  The  matrix  V2  is  the  null  space  of  a 
source  matrix  A. 


Calling  Sequence: 


CALL  V2SDEF  CV2, V2S, NV2MAX, NV2SMX, N, M> 


Input  Variables: 


V2 

NV2MAX 


NV2SMX 


N 

M 


The  real  two-dimensional  matrix  defining  the  null 
space  of  the  source  matrix  A. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  V2  in  the 
calling  program. 

The  integer  number  of  rows  used  in  the  original 
DIMENSION  statement  for  the  matrix  V2S  in  the 
calling  program. 

The  integer  number  of  rows  in  the  matrix  V2S. 
Restrictions:  N<NV2SMX 

The  integer  number  of  columns  of  the  matrices  V2 
and  V2S.  Also,  the  rank  of  the  source  matrix  A. 


Output  Variables: 


V2S 


The  real  N  by  M  matrix  defining  the  range  space  of 
achievable  eigenvectors  for  MODES.  The  elements 


of  V2S  are  the  same  as  the  elements  of  the  first  N 
rows  of  V2. 


Subroutine  YESORN 


Purpose: 


Finds  the  yes-oi — no  answer  to  the  question  asked  in  the 


calling  program. 


Calling  Sequence: 


CALL  YESORN  (ANSWER, DIARY) 


Input  Variable: 


DIARY 


The  logical  variable  indicating  if  any  WRITE 


statements  should  be  made  to  a  computer  file.  If 


DIARY  =  .TRUE.  then  the  WRITE  statement  will  be 


made.  If  DIARY  =  . FALSE.  ,  the  WRITE  statement 


will  not  be  made. 


Output  Variable: 


ANSWER 


The  logical  variable  containing  the  answer  to  the 


question  asked  in  the  calling  program.  If 


ANSWER  =  .TRUE. 


,  the  answer  is  yes.  If 


ANSWER  ■  . FALSE.  ,  the  answer  is  no. 
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Conclusions  and  Recommendations 


The  control  system  design  program  MODES  is  an  accurate, 
effective  tool  for  the  design  engineer.  By  entering  the 
equations  of  motion  for  a  controlled  system  in  matrix  form, 
and  specifying  a  desired  eigenstructure,  we  can  easily  find 
the  unique  closed-loop  feedback  gain  matrix  which  alters  the 
system's  eigenstructure  to  be  as  close  to  the  desired  as 
possible.  By  presenting  the  eigenstructure  as  well  as  a 
graphical  time  response  history  in  the  modern  control 
representation  of  our  system,  and  by  presenting  the 
resolvent  matrix,  poles  and  zeroes  in  the  classical 
representation,  MODES  is  not  only  a  good  design  tool,  it  is 
also  a  good  learning  aid  for  students  of  control  system 
design. 

Suggested  follow-on  efforts  include  modifying  MODES  so 
as  to  allow  the  designer  to  specify  only  parts  of  the  eigen¬ 
structure.  Because  some  mode  shapes  may  be  more  important 
to  a  particular  design  problem,  it  may  be  desired  to 
introduce  greater  design  freedom  by  leaving  some  components 
of  some  eigenvectors  unspecified.  This  way,  the  more 
critical  eigenvector  components  may  be  placed  closer  to 
their  desired  values.  Another  follow-on  effort  would  be  to 
incorporate  MODES  into  a  comprehensive  computer-aided 
control  system  design  package. 


Appendix  A:  MODES  Main  Program  Listing 

The  Fortran  listing  of  the  main  program  MODES  is  presented  below. 
This  listing  of  MODES  is  the  version  developed  for  the  VAX/VMS  computer 
Some  modifications,  as  discussed  in  the  Users'  Guide,  are  required  to 
compile  this  program  for  the  IBM  PC  compatible  computers. 


PROGRAM  MODES 

REAL  A(15, 15) ,B(15, 15) , EVEC(30, 15) , EVAL(30) , ATILDE( 15,15), 

+P(15, 15) ,R(15, 15) , PINV(15, 15) ,G(15 , 15) , Z( 15, 15) , WR( 15) , 

+WI(15) , ZTIL( 15,15) , WRTIL(15) , VITIL(15) ,T, PACH(60, 15) , 

+SETUP(60, 30) , PD(30) , S(30) , U(30, 30) , V(30, 30) , V2(60, 60) , V2S(30, 60) , 
+SV2S(60) ,UV2S(30, 30) , W2S(60, 60) ,SIGPLS(60, 30) , TEMPI (60, 60) , 
+UV2ST( 30 , 30 ) , TEMP2 ( 60 , 60 ) , PA( 60 ) 

LOGICAL  PROMPT, ANSWER, DIARY, OLD 
CHARACTER  FILE0*14 , TEST*1 
NMAX  =  15 
EFFECO  -  l.E-7 
WRITE(* , *)  '  ' 

WRITE(* ,*)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

VRITE(*, *)  '  ' 

WRITE(* , *)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*, *)  '  ' 

WRITE(* , *)  '  ' 

WRITE(* , *)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

WRITE(* , *)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

WRITE(* , *)  '  ' 

WRITE (*,*)  '  ' 

WRITE(* , *)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

ANSWER  =  .FALSE. 

WRITE(*,*)  'DO  YOU  WANT  A  FILE  OF  THIS  SESSION  OF  MODES?' 

CALL  YES0RN( DIARY, ANSWER) 

IF(DIARY)  THEN 


FILEO= ' J0URN1 ' 

OPEN(4 , FILE=FILEO , STATUS® ' NEW' ) 

REWIND  4 

VRITE(4,*)  'DO  YOU  WANT  THE  INTRODUCTORY  MESSAGE?' 

END  IF 

WRITE(* , *)  'DO  YOU  WANT  THE  INTRODUCTORY  MESSAGE?' 

CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  THEN 

WRITE(* , *)  'THE  PROGRAM  MODES  CALCULATES  THE  MATRIX  OF  FEEDBACK 
WRITE(*,*)  'GAINS  REQUIRED  TO  GIVE  A  CONTROLLED  SYSTEM  THE' 
WRITE(*,*)  'RESPONSE  CHARACTERISTICS  DESIRED  BY  THE  DESIGNER.' 
WRITE(* , *)  'THE  DESIRED  CHARACTERISTICS  ARE  SPECIFIED  BY' 
WRITE(* , *)  'DEFINING  THE  DESIRED  EIGENSTRUCTURE. ' 

WRITE(*,*)  '  ' 

WRITE(*,*)  'AFTER  ENTERING  THE  ORIGINAL  SYSTEM  MATRICES,  YOU' 
WRITE(*,*)  'HAVE  THE  OPTION  OF  SEEING  THE  TIME  RESPONSE' 

WRITE (*,*)  'CHARACTERISTICS' 

WRITE(*,*)  'OF  THE  ORIGINAL  SYSTEM  PLOTTED  ON  THE  SCREEN' 
WRITE(*,*)  '(A  TIME  HISTORY  SIMULATION),  THE  EIGENVALUES  ' 
WRITE(*,*)  'AND  EIGENVECTORS  (EIGENSTRUCTURE)  OF  THE  ' 
WRITE(*,*)  'ORIGINAL  SYSTEM  PLOTTED  ON  THE  SCREEN,  AS  WELL  AS' 
WRITE (*,*)  'THE  RESOLVENT  MATRIX  AND  POLES  AND  ZEROS.' 

WRITE (*,*)  'THEN  YOU  ARE  PROMPTED  FOR  THE  DESIRED' 

WRITE (*,*)  'EIGENSTRUCTURE.' 

WRITE(*,*)  '  ' 

WRITE (*,*)  'HIT  THE  RETURN  KEY  WHEN  READY  TO  CONTINUE.' 

READ(*, ' (F5.2) ' )  T 
WRITE(*, *)  '  ' 

WRITE ( * , *)  '  ' 

WRITE(*,*)  '  ' 

WRITE (*,*)  'AFTER  CALCULATING  THE  REQUIRED  FEEDBACK  GAIN  MATRIX 
WRITE(* , *)  'MODES  CALCULATES  THE  ACTUAL  EIGENSTRUCTURE  OF  THE' 
WRITE(* , *)  'MODIFIED  SYSTEM,  AND  OFFERS  TO  PRINT  BOTH  THE' 
WRITE(* , *)  'DESIRED  AND  THE  FINAL  EIGENSTRUCTURE.' 

WRITE(*,*)  '  ' 

WRITE(*, *)  'YOU  ARE  THEN  ASKED  IF  YOU  WANT  THE  TIME  RESPONSE' 
WRITE(* , *)  'CHARACTERISTICS  AND  THE  RESOLVENT  MATRIX  AND  POLES' 
WRITE(* , *)  'AND  ZEROS  PLOTTED  ON  THE  SCREEN.  THROUGHOUT  MODES, 
WRITE(* , *)  'YOU  ARE  ASKED  IF  YOU  WANT  TO  SAVE  THE  DATA  YOU  HAVE 
WRITE (*,*)  'ENTERED.' 

WRITE(* , * )  '  ' 

WRITE(*, *)  'YOU  ARE  LIMITED  TO  15  STATES  AND  15  INPUTS.' 
WRITE(*,*)  '  ' 

WRITE( * , * )  'HIT  THE  RETURN  KEY  WHEN  READY  TO  CONTINUE.' 
IF(DIARY)  THEN 

WRITE(4 , *)  'THE  PROGRAM  MODES  CALCULATES  THE  MATRIX  OF  FEEDBACK 
WRITE (4,*)  'GAINS  REQUIRED  TO  GIVE  A  CONTROLLED  SYSTEM  THE' 
WRITE(4 , * )  'RESPONSE  CHARACTERISTICS  DESIRED  BY  THE  DESIGNER.' 
VRITE(4, *)  'THE  DESIRED  CHARACTERISTICS  ARE  SPECIFIED  BY' 

WRITE( 4 , * )  'DEFINING  THE  DESIRED  EIGENSTRUCTURE.' 

WRITE(4,*)  '  ' 

WRITE( 4 , * )  'AFTER  ENTERING  THE  ORIGINAL  SYSTEM  MATRICES,  YOU' 
WRITE(4 , * )  'HAVE  THE  OPTION  OF  SEEING  THE  TIME  RESPONSE' 

WRITE( 4 , * )  'CHARACTERISTICS' 


WRITE(4,*)  'OF  THE  ORIGINAL  SYSTEM  PLOTTED  ON  THE  SCREEN' 
WRITE(4,*)  '(A  TIME  HISTORY  SIMULATION),  THE  EIGENVALUES  ' 

WRITE (4,*)  'AND  EIGENVECTORS  ( EIGENSTRUCTURE )  OF  THE  ' 

WRITE (4,*)  'ORIGINAL  SYSTEM  PLOTTED  ON  THE  SCREEN,  AS  WELL  AS' 
WRITE(4,*)  'THE  RESOLVENT  MATRIX  AND  POLES  AND  ZEROS.' 

WRITE(4, *)  'THEN  YOU  ARE  PROMPTED  FOR  THE  DESIRED' 

WRITE(4, *)  'EIGENSTRUCTURE.' 

WRITE(4,*)  '  ' 

WRITE(4 ,  *)  'HIT  THE  RETURN  KEY  WHEN  READY  TO  CONTINUE.' 

WRITE(4, *)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4, *)  'AFTER  CALCULATING  THE  REQUIRED  FEEDBACK  GAIN  MATRIX,' 
WRITE(4,*)  'MODES  CALCULATES  THE  ACTUAL  EIGENSTRUCTURE  OF  THE' 
WRITE(4,*)  'MODIFIED  SYSTEM,  AND  OFFERS  TO  PRINT  BOTH  THE' 
WRITE(4,*)  'DESIRED  AND  THE  FINAL  EIGENSTRUCTURE.' 

WRITE(4,*)  '  ' 

WRITE(4 , *)  'YOU  ARE  THEN  ASKED  IF  YOU  WANT  THE  TIME  RESPONSE' 
WRITE(4,*)  'CHARACTERISTICS  AND  THE  RESOLVENT  MATRIX  AND  POLES' 
WRITE(4, *)  'AND  ZEROS  PLOTTED  ON  THE  SCREEN.  THROUGHOUT  MODES,' 
WRITE (4,*)  'YOU  ARE  ASKED  IF  YOU  WANT  TO  SAVE  THE  DATA  YOU  HAVE' 
WRITE(4,*)  'ENTERED.' 

WRITE(4,*)  '  ' 

WRITE(4 , *)  'YOU  ARE  LIMITED  TO  15  STATES  AND  15  INPUTS.' 

WRITE(4 , *)  '  ' 

WRITE (4,*)  'HIT  THE  RETURN  KEY  WHEN  READY  TO  CONTINUE.' 

END  IF 

READ(*,'(F5.2)')  T 
END  IF 

WRITE(*,*)  '  ' 

WRITE (*,*)  '  ' 

WRITE(* , *)  '  ' 

WRITE(*, *)  'DO  YOU  WANT  ALL  INTERMEDIATE  RESULTS?' 

IF( DIARY)  THEN 
WRITE (4,*)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4, *)  '  ' 

WRITE(4 , *)  'DO  YOU  WANT  ALL  INTERMEDIATE  RESULTS?' 

END  IF 

CALL  YESORN( PROMPT, DIARY) 

30  VRITE(*, *)  '  ' 

IF(DIARY)  WRITE(4 , *)  '  ' 

CALL  DIMENA(N,M, DIARY) 

IF(N  .GT.  15)  THEN 

WRITE(*, *)  'A  CANNOT  BE  LARGER  THAN  15  BY  15' 

IF(DIARY)  WRITE(4, *)  'A  CANNOT  BE  LARGER  THAN  15  BY  15' 

GO  TO  30 
END  IF 

IF  (M  .GT.  N)  THEN 

WRITE(*,*)  'B  CANNOT  HAVE  MORE  COLUMNS  THAN  A' 

IF(DIARY)  WRITE(4 , *)  'B  CANNOT  HAVE  MORE  COLUMNS  THAN  A' 

GO  TO  30 
END  IF 
Ml  =  N  +  M 
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VRITE(*,*)  'ENTER  THE  ELEMENTS  OF  MATRIX  A' 

IF( DIARY)  WRITE (4,*)  'ENTER  THE  ELEMENTS  OF  MATRIX  A' 

CALL  INPUTA ( NMAX ,  N ,  N ,  A , DIARY ) 

WRITE (*,*)  'DO  YOU  WANT  TO  SAVE  THIS  A  MATRIX?' 

IF(DIARY)  WRITE(4,*)  'DO  YOU  WANT  TO  SAVE  THIS  A  MATRIX?' 

CALL  YESORN( ANSWER, DIARY) 

IF(ANSWER)  THEN 
FILEO=' JOURN2' 

CALL  SAVE ( A , EVEC , EVAL , N , N , DIARY, FI LEO , 1 ) 

END  IF 

WRITE(*,*)  'ENTER  THE  ELEMENTS  OF  MATRIX  B' 

IF(DIARY)  WRITE(4 , *)  'ENTER  THE  ELEMENTS  OF  MATRIX  B' 

CALL  INPUTA(NMAX,N,M,B, DIARY) 

WRITE (*,*)  'DO  YOU  WANT  TO  SAVE  THIS  B  MATRIX?' 

I F( DIARY)  WRITE(4, *)  'DO  YOU  WANT  TO  SAVE  THIS  B  MATRIX?' 

CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  THEN 
FILEO**' JOURN3' 

CALL  SAVE ( B , EVEC , EVAL , N , M , DI ARY , FI LEO , 1 ) 

END  IF 

WRITE (*,*)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 
WRITE(*,*)  'MATRIX  A  OF  THIS  SYSTEM?' 

IF(DIARY)  THEN 

WRITE(4, *)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 
WRITE(4,*)  'MATRIX  A  OF  THIS  SYSTEM?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  THEN 

CALL  EIGV( A, Z,WR,WI, NMAX, N, DIARY) 

CALL  PRINTZ ( Z, WR, WI, NMAX, N, DIARY) 

END  IF 

WRITE(* , *)  'DO  YOU  WANT  TO  HAVE  THE  TIME  RESPONSE  OF  THIS' 

WRITE (*,*)  'SYSTEM  PLOTTED  ON  THE  SCREEN?' 

IF (DIARY)  THEN 

WRITE(4,*)  'DO  YOU  WANT  TO  HAVE  THE  TIME  RESPONSE  OF  THIS' 

WRITE(4 , * )  'SYSTEM  PLOTTED  ON  THE  SCREEN?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  CALL  SIMUL8(A,B,N,M, NMAX, DIARY) 

WRITE(*,*)  'DO  YOU  WANT  THE  RESOLVENT  MATRIX  FOR  THIS  SYSTEM?' 
IF(DIARY)  THEN 

WRITE(4, *)  'DO  YOU  WANT  THE  RESOLVENT  MATRIX  FOR  THIS  SYSTEM?' 
END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  CALL  POLZER(A,B,N,M, DIARY) 

WRITE(*,*)  'NOW  ENTER  THE  DESIRED  EIGENSTRUCTURE.' 

I F( DIARY)  WRITE (4,*)  'NOW  ENTER  THE  DESIRED  EIGENSTRUCTURE.' 

CALL  EIGSTR( EVEC , EVAL , 2*NMAX , N , DIARY ) 

WRITE(*,*)  'DO  YOU  WANT  TO  SAVE  THIS  DESIRED  EIGENSTRUCTURE?' 
IF(DIARY)  THEN 

WRITE(4 , *)  'DO  YOU  WANT  TO  SAVE  THIS  DESIRED  EIGENSTRUCTURE?' 
END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  THEN 


VRITE(*,*)  'FOR  THE  EIGENVECTOR  MATRIX,' 

IF(DIARY)  WRITE(4 , *)  'FOR  THE  EIGENVECTOR  MATRIX,' 

FI LEO-' J0URN4' 

CALL  SAVE ( A , EVEC , EVAL , 2  *N , N , DI ARY , FI LEO , 2 ) 

WRITE (*,*)  'FOR  THE  EIGENVALUE  MATRIX,' 

IF(DIARY)  VRITE(4, *)  'FOR  THE  EIGENVALUE  MATRIX,' 

FILEO-' JOURN5' 

CALL  SAVE (A , EVEC , EVAL , 2*N , 1 , DI ARY , FI LEO , 3 ) 

END  IF 

IF  (PROMPT)  THEN 

WRITE(*, *)  'NOW  ENTERING  THE  DO-LOOP' 

IF( DIARY)  THEN 

WRITE(4,*)  'NOW  ENTERING  THE  DO-LOOP' 

WRITE(4 , * )  '  ' 

END  IF 
END  IF 

WRITE(*, *)  '  ' 

DO  40  I  =  1,  N 
EVALR  =  EVAL(I) 

EVALI  =  EVAL(I+N) 

IF  (PROMPT)  THEN 
WRITE(*, 36)  I 
WRITE(*,37)  EVALR 
WRITE( * , 38 )  EVALI 
IF(DIARY)  THEN 
WRITE(4 , 36)  I 
WRITE(4, 37)  EVALR 
WRITE (4, 38)  EVALI 
END  IF 

36  F0RMAT(1X, ' I  =  ',12) 

37  F0RMAT(1X, 'THE  REAL  PART  OF  THE  EIGENVALUE  IS  ',F15.8) 

38  F0RMAT(1X, 'THE  IMAGINARY  PART  IS  \F15.8) 

END  IF 

CALL  PDDEF ( EVEC , PD , 2 *NMAX , 2*N,N, I ) 

CALL  SETUPC ( A , B , EVALR , EVALI , SETUP ,N,M,2*N) 

CALL  SVD( SETUP , 4*NMAX, 2*NMAX, 2*M1 , 2*N, 2*M1 , 2*N, S, V, U, IER) 

CALL  V2DEF ( V , 4*NMAX , 2*M 1 , S , 2*NMAX , V2 , MV2 , EFFECO , DIARY ) 

CALL  V2SDEF( V2 , V2S, 4*NMAX , 2*NMAX, 2*N, MV2 ) 

CALL  SVD( V2S , 2*NMAX , 4*NMAX , 2*N , MV 2 , 2*N , MV2 , SV2S, UV2S, VV2S, IER) 
CALL  ATRANS ( 2*NMAX , 2*NMAX , 2*N, 2*N, UV2S, UV2ST) 

CALL  SIGPL(SV2S, SIGPLS, 4*NMAX, 4*NMAX, 2*N, MV2 , EFFECO) 

CALL  AXBEQC( W2S , 4*NMAX , MV2 , MV2 , SIGPLS , 4*NMAX , MV2 , 2*N , TEMPI , 
+4*NMAX, DIARY) 

CALL  AXBEQC(TEMP1 , 4*NMAX , MV2 , 2*N, UV2ST , 2*NMAX , 2*N , 2*N , TEMP2 , 
+4*NMAX, DIARY) 

CALL  AXBEQC( V2 , 4*NMAX, 2*M1 , MV2 ,TEMP2 , 4*NMAX, MV2 , 2*N, TEMPI , 
+4*NMAX, DIARY) 

CALL  AXBEQC(TEMP1 , 4*NMAX , 2*M1 , 2*N, PD, 2*NMAX , 2*N , 1 , PA , 4*NMAX , 
+DIARY) 

CALL  PACHDF(PA,PACH,4*NMAX,2*M1 ,N,I) 

IF  (PROMPT)  THEN 
WRITE( * , * )  '  ' 

WRITE( * , * )  'THE  MATRIX  PACH  IS' 

IF(DIARY)  THEN 
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VRITE(4 , *)  '  ' 

WRITE(4 , *)  'THE  MATRIX  PACH  IS' 

END  IF 

CALL  PRINTA( 4*NMAX , 2*M 1 , N , PACH , DIARY ) 

END  IF 
CONTINUE 

IF  (PROMPT)  THEN 

WRITE(* , *)  'END  OF  DO-LOOP' 

IF(DIARY)  WRITE(4 , *)  'END  OF  DO-LOOP' 

END  IF 

CALL  PNRDEF( PACH , P , R , 60 , 15 , 15 , N , M , EFFECO , DIARY) 

IF  (PROMPT)  THEN 

WRITE(* , *)  'THE  MATRIX  P  IS' 

IF(DIARY)  WRITE(4,*)  'THE  MATRIX  P  IS' 

CALL  PRINTA(15,N,N,P, DIARY) 

WRITE(* , *)  'THE  MATRIX  R  IS' 

IF(DIARY)  WRITE(4 , *)  'THE  MATRIX  R  IS' 

CALL  PRINTA(15,M,N,R, DIARY) 

END  IF 

CALL  INVERT (P, PINV, N, DIARY) 

IF  (PROMPT)  THEN 

WRITE (*,*)  'THE  INVERSE  OF  P  IS  PINV: ' 

IF(DIARY)  WRITE (4,*)  'THE  INVERSE  OF  P  IS  PINV:' 

CALL  PRINTA(15,N,N, PINV, DIARY) 

END  IF 

CALL  AXBEQC(R, 15,M,N,PINV, 15,N,N,G, 15, DIARY) 

WRITE(* , *)  'THE  CALCULATED  FEEDBACK  GAIN  MATRIX  G  IS' 

I F( DIARY)  WRITE(4,*)  'THE  CALCULATED  FEEDBACK  GAIN  MATRIX  G  IS' 
CALL  PRINTA(NMAX,M,N,G, DIARY) 

WRITE (*,*)  'DO  YOU  WANT  TO  SAVE  THIS  GAIN  MATRIX?' 

IF( DIARY)  WRITE (4,*)  'DO  YOU  WANT  TO  SAVE  THIS  GAIN  MATRIX?' 
CALL  YESORN( ANSWER, DIARY) 

IF (ANSWER)  THEN 
FILEO=' JOURN6' 

CALL  SAVE ( G , EVEC , EVAL , M , N , DI ARY , FI LEO , 1 ) 

END  IF 

CALL  ATLDEF ( A , B , G , ATI LDE , NMAX , N , M , DIARY ) 

WRITE(*,*)  'THE  NEW  MATRIX  A-TILDE  IS' 

IF( DIARY)  WRITE(4 , *)  'THE  NEW  MATRIX  A-TILDE  IS' 

CALL  PRINTA(NMAX,N, N, ATI LDE, DIARY) 

WRITE (*,*)  'DO  YOU  WANT  TO  SAVE  THIS  A-TILDE  MATRIX?' 
IF(DIARY)WRITE(4 , *)  'DO  YOU  WANT  TO  SAVE  THIS  A-TILDE  MATRIX?' 
CALL  YESORN( ANSWER, DIARY) 

I F( ANSWER)  THEN 
FILEO=' JOURN7' 

CALL  SAVE ( ATI LDE , EVEC , EVAL , N , N , DI AR Y , FI LEO , 1 ) 

END  IF 

WRITE(*, *)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 

WRITE( * , * )  'NEW,  MODIFIED  SYSTEM?' 

IF(DIARY)  THEN 

WRITE(4,*)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 
WRITE(4, *)  'NEW,  MODIFIED  SYSTEM?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 


IF  (ANSWER)  THEN 

WRITE (*,*)  'THE  EIGENSTRUCTURE  OF  A-TILDE  =  A-BG  IS' 

IF(DIARY)  THEN 

WRITE(4,*)  'THE  EIGENSTRUCTURE  OF  A-TILDE  -  A-BG  IS' 

END  IF 

CALL  EIGV ( ATI LDE , ZTIL , WRTIL , WITIL , NMAX , N , DIARY ) 

CALL  PRINTZ(ZTIL, WRTIL, WITIL, NMAX , N , DIARY ) 

END  IF 

WRITE (*,*)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 
WRITE(*,*)  'ORIGINAL,  UNMODIFIED  SYSTEM?' 

IF(DIARY)  THEN 

WRITE (4,*)  'DO  YOU  WANT  TO  SEE  THE  EIGENSTRUCTURE  OF  THE' 
WRITE(4,*)  'ORIGINAL,  UNMODIFIED  SYSTEM?' 

END  IF 

CALL  YESOP.N( ANSWER, DIARY) 

IF  (ANSWER)  THEN 

CALL  EIGV( A, Z,WR,WI, NMAX, N, DIARY) 

CALL  PRINTZ (Z,WR,WI, NMAX, N, DIARY) 

END  IF 

WRITE(*,*)  'DO  YOU  WANT  THE  TIME  RESPONSE  OF  THIS  MODIFIED' 
WRITE(*,*)  'SYSTEM  PLOTTED  ON  THE  SCREEN?' 

IF(DIARY)  THEN 

WRITE(4,*)  'DO  YOU  WANT  THE  TIME  RESPONSE  OF  THIS  MODIFIED' 
WRITE (4,*)  'SYSTEM  PLOTTED  ON  THE  SCREEN?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  CALL  SIMUL8(ATILDE,B,N,M, NMAX, DIARY) 

WRITE(*,*)  'DO  YOU  WANT  THE  RESOLVENT  MATRIX  FOR  THE  MODIFIED' 
WRITE (*,*)  'SYSTEM?' 

IF (DIARY)  THEN 

WRITE (4,*)  'DO  YOU  WANT  THE  RESOLVENT  MATRIX  FOR  THE  MODIFIED 
WRITE (4,*)  'SYSTEM?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  CALL  POLZER( ATI LDE , B , N , M , DIARY ) 

IF(DIARY)  CL0SE(4) 

END 
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Appendix  B:  MODES  Subroutines  Listing 

The  Fortran  listing  of  the  subroutines  for  MODES  is  presented  below. 
This  listing  is  the  version  developed  for  the  VAX/VMS  computer.  Some  modi¬ 
fications,  as  discussed  in  the  Users'  Guide,  are  required  to  compile  this 
program  for  the  IBM  PC  compatible  computers. 


C**************************************** ***************************** | 

SUBROUTINE  ATLDEF ( A , B , G , ATILDE , NM , N , M , DIARY ) 

C  I 

C  DEFINES  THE  MATRIX  A-TILDE  FROM  THE  MATRICES  A,  B,  AND  G  j 

£***★★***★****★*★***★★**★*★★**★*★*★★★★★★★★★★★★★★★★*★★*******★*★****★★* | 

REAL  A(NM,N) ,B(NM, M) ,G(NM,N) , ATILDE (NM,N) 

LOGICAL  DIARY 

CALL  AXBEQC(B,NM,N,M,G,NM,M,N, ATILDE, NM, DIARY) 

DO  10  I  -  1,  N 
DO  10  J  -  1,  N 

ATILDE(I.J)  =  A(I , J)  ♦  ATILDE(I, J) 

10  CONTINUE 

VRITE( * , *)  '  ' 

WRITE(*,*)  '  ' 

RETURN 

END 

C********************************************************************* | 

SUBROUTINE  ATRANS ( NM , MN , N , M , A , AT ) 

C  I 

C  DEFINING  A-TRANSPOSE,  AT(M,N)  j 

C************************************** *******************************  j 
REAL  A(NM,M) , AT(MN,N) 

DO  20  I-1,N 

DO  10  J=1 , M 

AT(J, I)=A(I, J) 

10  CONTINUE 

20  CONTINUE 
RETURN 
END 

C************************************* ********************************  j 

SUBROUTINE  AXBEQC( A , NMAXA , NA , MA , B , NMAXB , NB , MB , C , NMAXC , DIARY ) 

C  I 

C  MULTIPLIES  MATRICES  A  AND  B  TO  YIELD  MATRIX  C  | 

C** ************************************************** ***************** | 

REAL  B(NMAXB , MB ) , A(NMAXA , MA) , C(NMAXC , MB ) 

LOGICAL  DIARY 


•„vi 

v. 


V 


B-l 


no  n  ooooo  noon 


IF  (MA  .EQ.  NB)  THEN 
DO  10  K  =  1,  NA 

DO  10  J  -  1,  MB 
C(K,J)  -  0.0 
DO  10  I  =  1,  MA 

C(K, J)  =  C(K,J)  +  A(K, I)  *  B(I, J) 

10  CONTINUE 

ELSE 

WRITE(*,*)  'THE  MATRIX  DIMENSIONS  ARE  NOT  COMPATIBLE  FOR' 
WRITE(*,*)  'MULTIPLICATION' 

WRITE(*,*)  'THE  FIRST  MATRIX  IS',NA,'  BY' ,MA 
WRITE(*,*)  'THE  SECOND  MATRIX  IS',NB,'  BY', MB 
IF (DIARY)  THEN 

WRITE(4, *)  'THE  MATRIX  DIMENSIONS  ARE  NOT  COMPATIBLE  FOR' 
WRITE (4,*)  'MULTIPLICATION' 

WRITE(4,*)  'THE  FIRST  MATRIX  IS',NA,'  BY' ,MA 
WRITE(4, *)  'THE  SECOND  MATRIX  IS',NB,'  BY' ,MB 
END  IF 
END  IF 
RETURN 
END 

C****************************  ********************************  **********  | 
SUBROUTINE  BALANC( NM , N , A , LOW , IGH , SCALE ) 


BALANCES  A  REAL  GENERAL  MATRIX  TO  BE  USED  WITH  HQR2 ,  ELTRAN,  | 

ELMHES,  AND  BALBAK  TO  FIND  THE  EIGENVALUES  AND  EIGENVECTORS  | 

********************************************************************** | 


REAL  A(NM,N) , SCALE(N) 
REAL  C,F,G,R,S,B2, RADIX 
REAL  ABS 
LOGICAL  NOCONV 


**********  RADIX  IS  A  MACHINE  DEPENDENT  PARAMETER  SPECIFYING 

THE  BASE  OF  THE  MACHINE  FLOATING  POINT  REPRESENTATION. 


★★★★★★★★★★ 
RADIX  -  16. 


B2  =  RADIX  *  RADIX 
K  =  1 
L  -  N 
GO  TO  100 

**********IN_LINE  PROCEDURE  FOR  ROW  AND 
COLUMN  EXCHANGE  ********** 

20  SCALE(M)  «  J 

IF  (J  .EQ.  M)  GO  TO  50 
C 

DO  30  I  -  1,  L 
F  .  A( I , J) 

A(I,J>  =  A(I,M) 

A(I,M)  =  F 
30  CONTINUE 
C 

DO  40  I  =  K,  N 
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F  -  A(J,I) 

A(J,I)  -  A(M, I) 

A(M, I)  -  F 
40  CONTINUE 
C 

50  GO  TO  (80,130),  IEXC 

C  **********  SEARACH  FOR  ROWS  ISOLATING  AN  EIGENVALUE 
C  AND  PUSH  THEM  DOWN  ********** 

80  IF  (L  .EQ.  1)  GO  TO  280 
L  -  L  -  1 

C  **********  for  j„L  STEp  _i  UNTIL  !  do  __  ********** 
100  DO  120  JJ  *  1,  L 
J  ■  L  +  1  -  JJ 

C  ' 


110 

C 


120 

C 


DO  110  I  ■  1,  L 

IF  (I  .EQ.  J)  GO  TO  110 
IF  ( A( J , I )  .NE.  0.0)  GO  TO  120 
CONTINUE 

M  *  L 
IEXC  -  1 
GO  TO  20 
CONTINUE 


150 

C 


170 

C 

180 

C 

190 

C 


GO  TO  140 

**********  SEARCH  FOR  COLUMNS  ISOLATING  AN  EIGENVALUE 
AND  PUSH  THEM  LEFT  ********** 


K  *  K  +  1 

DO  170  J  -  K,  L 

DO  150  I  -  K,  L 

IF  (I  .EQ.  J)  GO  TO  150 
IF  (A(I , J)  .NE.  0.0)  GO  TO  170 
CONTINUE 

M  *  K 
IEXC  -  2 
GO  TO  20 
CONTINUE 

D0*180*I**  BALANCE  THE  SUBMATRIX  IN  ROWS  K  TO  L  ********** 
SCALE(I)  .  l.’o 

**********  ITERATIVE  LOOP  FOR  NORM  REDUCTION  ********** 

NOCONV  -  .FALSE. 


V 


A 


> 
*  tt 

£ 

| 

I 


••  .v 


DO  270  I  *  K,  L 
C  -  0.0 
R  *  0.0 

DO  200  J  -  K,  L 

IF  (J  .EQ.  I)  GO  TO  200 
C  =  C  +  ABS(A( J , I) ) 
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* 

S 

1 

m 

fv 

§ 


R  =  R  +  ABS(A(I, J) ) 

200  CONTINUE 

C  **********  GUARD  AGAINST  ZERO  C  OR  R  DUE  TO  UNDERFLOW  ********** 

IF  (C  .EQ.  0.0  .OR.  R  .EQ.  0.0)  GO  TO  270 
G  -  R  /  RADIX 
F  =  1.0 
S  =  C  +  R 

210  IF  (C  .GE.  G)  GO  TO  220 
F  =  F  *  RADIX 
C  =«  C  *  B2 
GO  TO  210 

220  G  =  R  *  RADIX 

230  IF  (C  .LT.  G)  GO  TO  240 

F  =  F  /  RADIX 
C  =  C  /  B2 
GO  TO  230 

C  **********  now  BALANCE  ********** 

240  IF  ((C  +  R)  /  F  .GE.  0.95  *  S  )  GO  TO  270 
G  ■  1.0  /  F 

SCALE(I)  -  SCALE(I)  *  F 
NOCONV  =  .TRUE. 

C 

DO  250  J  «  K,  N 
250  A(I,J)  =  A(I, J)  *  G 
C 

DO  260  J  .  1,  L 
260  A( J ,  I )  *  A( J ,  I )  *  F 

C 

270  CONTINUE 
C 

IF  (NOCONV)  GO  TO  190 
C 

280  LOW  *  K 
IGH  -  L 
RETURN 
END 

SUBROUTINE  BALBAK( NM,N, LOW, IGH, SCALE ,M,Z) 

C  I 

C  TO  BACK  TRANSFORM  THE  EIGENVECTORS  OF  THE  REAL  GENERAL  | 

C  MATRIX  TRANSFORMED  BY  BALANC  j 

j 

INTEGER  I,J,K,M,N,II,NM,IGH,LOV 
REAL  SCALE(N) , Z(NM, M) 

REAL  S 


DO  100  J  =  1,  M 
100  Z(I,J)  =  Z(I,J)  *  S 
C 

110  CONTINUE 
C 

c  ********_  FOR  I-LOW-1  STEP  -1  UNTIL  1, 

C  IGH+1  STEP  1  UNTIL  N  DO  —  ********** 

120  DO  140  II  -  1,  N 
I  =  II 

IF  (I  .GE.  LOW  .AND.  I  .LE.  IGH)  GO  TO  140 
IF  (I  .LT.  LOW)  I  -  LOW  -  II 
K  =  SCALE(I) 

IF  (K  .EQ.  I)  GO  TO  140 
C 

DO  130  J  -  1,  M 
S  =  Z(I,J) 

Z(I,J)  -  Z(K, J) 

Z(K, J)  *  S 
130  CONTINUE 
C 

140  CONTINUE 
C 

200  RETURN 
END 

SUBROUTINE  COPYAB(NMAX,N,M, A,B) 

C  I 

C  DEFINES  MATRIX  B  -  MATRIX  A  j 

Qick'kirk'k'k'k'kit'k'k'k'k'k'kirk'k'k'k'k'k'kirkirk'k  J 

REAL  A(NMAX,M) ,B(NMAX,M) 

DO  20  I  *  1,  N 
DO  10  J  -  1,  M 
B(I,J)  =  A(I , J) 

10  CONTINUE 
20  CONTINUE 
RETURN 
END 

£***************************#******************************************  | 

SUBROUTINE  DAXBEC( A , NMAXA , NA , MA , B , NMAXB , NB , MB , C , NMAXC , DIARY ) 

C  I 

C  A  DOUBLE  PRECISION  ROUTINE  TO  MULTIPLY  TWO  MATRICES  (A&B)  | 

c*** ★★★★★★★★★★★**★★★★★★★*★* *★★*★** | 

DOUBLE  PRECISION  A(NMAXA,MA) , B(NMAXB,MB) ,C(NMAXC, MB) 

LOGICAL  DIARY 
IF(MA  .EQ.  NB)  THEN 
DO  10  K  .  1,  NA 
DO  10  J  =  1,  MB 
C(K, J)  «  0. DO 
DO  10  I  *  1,  MA 

C(K, J)  =  C(K,J)  +  A(K,I)  *  B(I,J) 

10  CONTINUE 
ELSE 

WRITE(*, *) 'THE  MATRIX  DIMENSIONS  ARE  NOT  COMPATIBLE  FOR' 
WRITE(*,*) 'MULTIPLICATION' 


n  n 


WRITE(*, *) 'THE  FIRST  MATRIX  IS',NA,'  BY'.MA 
WRITE(*,*)'THE  SECOND  MATRIX  IS' ,NB, '  BY' ,MB 
IF(DIARY)  THEN 

WRITE(4, *) 'THE  MATRIX  DIMENSIONS  ARE  NOT  COMPATIBLE  FOR' 
WRITE ( 4 , * ) ' MULTIPLICATION ' 

WRITE(4,*) 'THE  FIRST  MATRIX  IS'.NA,'  BY' ,MA 
VRITE(4, *) 'THE  SECOND  MATRIX  IS',NB,'  BY' ,MB 
END  IF 
END  IF 
RETURN 
END 

Qirk'k'k'k'kick'klrk'k'kirk'k-k'k-klt'k'k-k'k'k'kiek'k'k'kirlck'k'kick'k'kirk'kiticjt'k'k'klcirk'k'k'k'k  J 

SUBROUTINE  DIMENA(N,M, DIARY) 

I 

THIS  SUBROUTINE  READS  IN  N  AND  M  j 

C ********************************* *********************************** ) 

INTEGER  M,N 
LOGICAL  ANSWER, DIARY 

10  WRITE(*, *)  'WHAT  IS  THE  NUMBER  OF  ROWS  AND  COLUMNS  (N)  OF' 
WRITE(*,*)  'THE  SQUARE  MATRIX  A  {THE  NUMBER  OF  STATES)?' 

READ  (*,20)  N 
20  FORMAT (12) 

I F( DIARY)  THEN 

WRITE (4,*)  'WHAT  IS  THE  NUMBER  OF  ROWS  AND  COLUMNS  (N)  OF' 
WRITE(4,*)  'THE  SQUARE  MATRIX  A  (THE  NUMBER  OF  STATES)?' 
WRITE(4, *)  N 

WRITE(4 , *)  'HOW  MANY  COLUMNS  (M)  OF  THE  N  BY  M  MATRIX  B' 

WRITE (4,*)  '(THE  NUMBER  OF  INPUTS)?' 

END  IF 

WRTTE(*, *)  'HOW  MANY  COLUMNS  (M)  OF  THE  N  BY  M  MATRIX  B' 
WRITE(*,*)  '(THE  NUMBER  OF  INPUTS)?' 

READ(*,30)  M 
30  FORMAT (12) 

IF(DIARY)  THEN 
WRITE(4,*)  M 

WRITE(4,*)  'THE  SYSTEM  HAS  ' ,N, '  STATES  AND  ',M,'  INPUTS' 
WRITE(4,*)  'IS  THIS  CORRECT?' 

END  IF 

WRITE (*, *)  'THE  SYSTEM  HAS  ',N,'  STATES  AND  ',M,'  INPUTS' 
WRITE(*,*)  'IS  THIS  CORRECT?' 

CALL  YESORN( ANSWER, DIARY) 

I F( ANSWER)  THEN 
RETURN 
ELSE 

GO  TO  10 
END  IF 

WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

IF( DIARY)  THEN 
WRITE(4,*)  '  ' 

WRITE(4 , *)  '  ' 

END  IF 
RETURN 
END 


C*** ******************************* ************************************ | 

SUBROUTINE  EIGSTR(EVEC,EVAL,NMX2 ,N, DIARY) 

C  I 

C  DEFINES  THE  DESIRED  EIGENSTRUCTURE  AND  DEFINES  THE  NEEDED  j 

C  MATRICES  FROM  THIS  DEFINITION  j 

c* ************************ ************** ********* ********************** | 
REAL  EVEC ( NMX2 ,  N ) , EV AL ( NMX2 ) 

LOGICAL  COMP, ANSWER, DIARY, KBRD 
CHARACTER  TEST*1 , FILEI*14, FILEII*14 
COMP-. FALSE. 

N2  -  N+N 
WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

1  WRITE(*,*)  'DO  YOU  WANT  TO  USE  A  NEW  EIGENSTRUCTURE  MATRIX' 
WRITE(*, *)  'ENTERED  FROM  THE  KEYBOARD,  ' 

WRITE(*,*)  'OR  ONE  ALREADY  STORED  ON  THE  COMPUTER?' 

WRITE(*, *)  '  ' 

WRITE (*,*)  'ENTER:  K  FOR  KEYBOARD  OR  C  FOR  COMPUTER' 

IF(DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE(4,*)  '  ' 

WRITE (4,*)  'DO  YOU  WANT  TO  ENTER  THE  EIGENSTRUCTURE  FROM' 

WRITE (4,*)  'THE  KEYBOARD,  OR  FROM  MATRICES  ALREADY' 

WRITE (4,*)  '  STORED  ON  THE  COMPUTER?' 

WRITE(4,*>  '  ' 

WRITE (4,*)  'ENTER:  K  FOR  KEYBOARD  OR  C  FOR  COMPUTER' 

END  IF 

READ(*, '(Al)')  TEST 
IF (DIARY)  WRITE(4,*)  TEST 

KBRD  -  ((LLE(TEST,'K')  .AND.  LGE(TEST, ’K’ ))  .OR. 

+(LLE(TEST, 'k' )  .AND.  LGE(TEST, '  k' ) ) ) 

IF  (KBRD)  GO  TO  2 

IF((LLT(TEST,'C')  .OR.  LGT(TEST, ' C  ) )  .AND. 

+(LLT(TEST, ' c' )  .OR.  LGT(TEST, ' c' )))  GO  TO  1 
WRITE(*, *)  '  ' 

WRITE (*, *)  '  ' 

WRITE(*, *)  '  ' 

IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4, *)  '  ' 

END  IF 
GO  TO  500 
C 

C  OPTION  1:  ENTERING  DATA  FROM  THE  KEYBOARD 
C 

2  WRITE(*,*)  '  ' 

WRITE(*,*)  'COMPLEX  EIGENVECTORS  AND  EIGENVALUES  MUST  APPEAR  IN' 
WRITE(*,*)  'COMPLEX  CONJUGATE  PAIRS.  WHEN  YOU  ENTER  ONE  COMPLEX' 
WRITE(*,*)  'VECTOR  OR  VALUE,  THE  COMPLEX  CONJUGATE  WILL  BE' 
WRITE(*, *)  'DEFINED  BY  THE  PROGRAM  AUTOMATICALLY.' 

VRITE(*, *)  '  ' 

IF (DIARY)  THEN 
WRITE(4 , *)  '  ' 


WRITE(4, *)  'COMPLEX  EIGENVECTORS  AND  EIGENVALUES  MUST  APPEAR  IN' 
WRITE (4,*)  'COMPLEX  CONJUGATE  PAIRS.  WHEN  YOU  ENTER  ONE  COMPLEX' 
WRITE(4,*)  'VECTOR  OR  VALUE,  THE  COMPLEX  CONJUGATE  WILL  BE' 
WRITE(4,*)  'DEFINED  BY  THE  PROGRAM  AUTOMATICALLY.' 

WRITE(4 , *)  '  ' 

END  IF 
TTEST=1 .0 
DO  400  K=1,N 

IF(TTEST  .LT.  0.0)  GOTO  300 
10  WRITE(*, 15)  K 

IF(DIARY)  VRITE(4, 15)  K 

15  FORMAT (IX, ' IS  THE  DESIRED  EIGENVALUE  NUMBER  ',12,'  COMPLEX?') 
CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  THEN 
IF(K.EQ.N)  THEN 

WRITE (*,*)  'YOU  ALREADY  HAVE  TOO  MANY  EIGENVALUES  TO' 
WRITE(* , *)  'DEFINE  A  COMPLEX  CONJUGATE.' 

IF(DIARY)  WRITE(4, *)  'YOU  ALREADY  HAVE  TOO  MANY  EIGENVALUES  TO' 
IF(DIARY)  WRITE (4,*)  'DEFINE  A  COMPLEX  CONJUGATE.' 

GO  TO  10 
END  IF 

COMP  -  .TRUE. 

WRITE(*,16) 

WRITE(*, 17)  K 
IF(DIARY)  WRITE(4, 16) 

IF(DIARY)  WRITE(4, 17)  K 

16  F0RMAT(1X, 'THE  REAL  PART  OF  THE  DESIRED') 

17  FORMAT (IX, 'EIGENVALUE  NUMBER',12,'  =  ?') 

READ(*,*)  EVAL(K) 

EVAL(K+1 )  -  EVAL(K) 

IF(DIARY)  THEN 

WRITE(4, 21)  EVAL(K) 

21  FORMAT( IX, F15. 7) 

WRITE (4,*)  'THE  IMAGINARY  PART  *  ?' 

END  IF 

WRITE(*,*)  'THE  IMAGINARY  PART  *  ?' 

READ(*, *)  EVAL(K+N) 

EVAL(K+N+1)  =  -EVAL(K+N) 

IF( DIARY)  THEN 

WRITE(4,21)  EVAL(K+N) 

WRITE(4, *)  '  ' 

WRITE(4 , * )  'FOR  THE  CORRESPONDING  EIGENVECTOR' 

END  IF 

WRITE(*, *)  '  ' 

WRITE (*,*)  'FOR  THE  CORRESPONDING  EIGENVECTOR' 

DO  100  I  -  1,N 
WRITE (*,34) 

WRITE(*,35)  I 
IF(DIARY)  WRITE(4,34) 

IF(DIARY)  WRITE(4, 35)  I 

34  F0RMAT(1X, 'THE  REAL  PART  OF  THE  DESIRED  EIGENVECTOR') 

35  FORMAT( IX, 'ELEMENT  NUMBER',12,'  =  ?') 

READ(* , *)  EVEC(I,K) 

IF(DIARY)  THEN 
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WRITE(4,21)  EVEC(I,K) 

WRITE(4 , *)  'THE  IMAGINARY  PART  =  ?' 

END  IF 

WRITE (*,*)  'THE  IMAGINARY  PART  =  ?' 

READ(*,*)  EVEC(I+N,K) 

IF(DIARY)  WRITE(4,21)  EVEC(I+N,K) 
EVEC(I,K+1)*EVEC(I,K) 

EVEC ( I +N , K+ 1 ) = -EVEC ( I +N , K ) 

100  CONTINUE 

ELSE 

WRITE(*,105)  K 
IF(DIARY)  WRITE(4, 105)  K 

105  F0RMAT(1X, 'THE  DESIRED  EIGENVALUE  NUMBER  ',12,'  =  ?') 

READ(*,*)  EVAL(K) 

IF( DIARY)  THEN 

WRITE(4,21)  EVAL(K) 

WRITE<4,*)  'FOR  THE  CORRESPONDING  EIGENVECTOR,' 

END  IF 

WRITE (*,*)  'FOR  THE  CORRESPONDING  EIGENVECTOR,' 

DO  200  I  «  1,N 

WRITE(*, 115)  I 
IF(DIARY)  WRITE(4, 115)  I 

115  FORMAT( IX, 'ELEMENT  NUMBER  ',12,'  -  ?') 

READ(*,*)  EVEC(I,K) 

IF(DIARY)  WRITE(4,21)  EVEC(I,K) 

200  CONTINUE 

TTEST  *  -1 . 0*TTEST 
END  IF 

300  TTEST  *  -1 .0*TTEST 
400  CONTINUE 
GO  TO  600 

OPTION  2:  ENTERING  DATA  FROM  AN  EXISTING  COMPUTER  DATA  FILE 

500  WRITE (*,*) 'WHAT  IS  THE  EIGENVECTOR  INPUT  FILE  NAME?' 
READ(*, ' (A) ' )  FILEI 
IF (DIARY)  THEN 

WRITE(4,*) 'WHAT  IS  THE  EIGENVECTOR  INPUT  FILE  NAME?' 
WRITE (4,*)  FILEI 
END  IF 

OPEN( 3 , FILE=FILEI , STATUS= ' OLD' ) 

REWIND  3 

READ(3,*,ERR*510,END=520)  ( (EVEC(I , J) , J-l ,N) , 1=1 ,N2) 

GO  TO  530 

510  WRITE(6,*)  ' ***ERROR  IN  INPUT  FILE***' 

IF(DIARY)  WRITE(4,*)  '***ERROR  IN  INPUT  FILE***' 

GO  TO  500 

520  WRITE(6, *)  '***ERROR:  END  OF  FILE  REACHED***' 

IF(DIARY)  WRITE(4,*)  '***ERROR:  END  OF  FILE  REACHED***' 

GO  TO  500 
530  CLOSE( 3) 

540  WRITE (*,*)' WHAT  IS  THE  EIGENVALUE  INPUT  FILE  NAME?' 

READ(* , ' (A) ' )  FILEII 
IF(DIARY)  THEN 


TflTT 


.V\ 


<0 


v."> 


WRITE (4,*)' WHAT  IS  THE  EIGENVALUE  INPUT  FILE  NAME?' 

WRITE(4, *)  FILEII 
END  IF 

0PEN(3,FILE*FILEII, STATUS- 'OLD' ) 

REWIND  3 

RE AD (3 , * , ERR-550 , END-560 )  (EVAL( I ) , 1=1 ,N2) 

GO  TO  570 

550  WRITE(6,*)  '***ERROR  IN  INPUT  FILE***' 

IF(DIARY)  WRITE(4, *)  '***ERR0R  IN  INPUT  FILE***' 

GO  TO  540 

560  WRITE(6,*)  '***ERROR:  END  OF  FILE  REACHED***' 

IF(DIARY)  WRITE(4f *)  '***ERR0R:  END  OF  FILE  REACHED***' 

GO  TO  540 
570  CL0SE(3) 

600  CONTINUE 

DO  630  I  =  1,  N 
WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

IF(EVAL(I+N)  .EQ.  0.0)  THEN 
WRITE (*,605)  I,EVAL(I) 

605  FORMAT (IX, 'EIGENVALUE  #  ',12,'  IS  ',F15.7) 

WRITE(*,*)  '  ' 

WRITE (*,*)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

WRITE (* , *)  '  ' 

DO  610  J  =  1,  N 

WRITE(*,*)  EVEC(J, I) 

CONTINUE 
ELSE 

WRITE(*,615)  I ,EVAL(I) ,EVAL(I+N) 

FORMAT( IX, 'EIGENVALUE  #  ',12,'  IS  ',F15.7,'  +  ',F15.7,'i') 
WRITE(*, *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

DO  625  J  =  1,  N 

WRITE(*,620)  EVEC(J,I) ,EVEC(J+N,I) 

FORMAT( IX, F15. 7 , '  +  ',F15.7,'i') 

CONTINUE 
END  IF 
630  CONTINUE 

WRITE(*,*)  '  ' 

WRITE(*,*)  'IS  THIS  THE  DESIRED  EIGENSTRUCTURE? ' 

IF(DIARY)  THEN 
DO  650  I  =  1,  N 
WRITE(4,*) 

WRITE(4,*) 

IF(EVAL(I+N)  .EQ.  0.0)  THEN 
WRITE(4,605)  I,EVAL(I) 

WRITE(4 , *)  '  ' 

WRITE(4, *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

WRITE(4 , *)  '  ' 

DO  635  J  =  1,  N 

WRITE(4, *)  EVEC( J , I ) 

635  CONTINUE 
ELSE 

WRITE(4,615)  I,EVAL(I) ,EVAL(I+N) 

WRITE(4, *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 


610 


615 


620 

625 


t  / 
/  t 
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DO  640  J  =  1,  N 

WRITE(4,620)  EVEC(J,I) ,EVEC( J+N,I) 

640  CONTINUE 

END  IF 
650  CONTINUE 

WRITE(4,*)  '  ' 

WRITE(4,*)  'IS  THIS  THE  DESIRED  EIGENSTRUCTURE? ' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  GO  TO  999 

655  WRITE(*,*)  'DO  YOU  WANT  TO  EDIT  THIS  EIGENSTRUCTURE,' 

WRITE (*,*)  'OR  ENTER  A  NEW  MATRIX  FROM  A  COMPUTER  FILE?' 

IF( DIARY)  WRITE (4,*)  'DO  YOU  WANT  TO  EDIT  THIS  EIGENSTRUCTURE,' 
IF(DIARY)  WRITE(4,*)'0R  ENTER  A  NEW  MATRIX  FROM  A  COMPUTER  FILE? 


660  WRITE (*,*)  'ENTER: 

E  TO  EDIT 

OR 

C  FOR  COMPUTER' 

READ(*, ' (Al) ' )  TEST 

IF( DIARY)  THEN 

WRITE (4,*)  'ENTER: 

E  TO  EDIT 

OR 

C  FOR  COMPUTER' 

WRITE (4,*)  TEST 
END  IF 

KBRD  -  ((LLE(TEST, 'E' )  .AND.  LGE(TEST, 'E' ))  .OR. 

+(LLE(TEST, ' e' )  .AND.  LGE(TEST, 'e' ))) 

IF  (KBRD)  GO  TO  700 

IF( (LLT(TEST, 'C' )  .OR.  LGT(TEST, 'C' ) )  .AND. 

+(LLT(TEST, ' c' )  .OR.  LGT(TEST, ' c' ) ) )  GO  TO  660 
GO  TO  500 

700  WRITE(* , *)  '  ' 

WRITE (*,*)  'WHEN  YOU  EDIT  A  COMPLEX  EIGENVALUE/ VECTOR,  YOU' 
WRITE(* ,*)  'MUST  ALSO  EDIT  THE  CONJUGATE.' 

WRITE(*, *)  'WHICH  EIGENVALUE/VECTOR  HAS  AN  INCORRECT  ENTRY?' 

IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE (4,*)  'WHEN  YOU  EDIT  A  COMPLEX  EIGENVALUE/ VECTOR ,  YOU' 
WRITE(4,*)  'MUST  ALSO  EDIT  THE  CONJUGATE.' 

WRITE(4 , *)  'WHICH  EIGENVALUE/VF.  jR  HAS  AN  INCORRECT  ENTRY?' 
END  IF 

READ(*, 710)  KK 
710  FORMAT (12) 

IF(DIARY)  THEN 
WRITE(4 , *)  KK 

IF(EVAL(KK+N)  .EQ.  0.0)  THEN 
WRITE(4,605)  KK, EVAL(KK) 

WRITE(4, *)  '  ' 

WRITE(4, *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

WRITE(4,*)  '  ' 

DO  720  J  -  1,  N 

WRITE(4 , * )  EVEC(J.KK) 

720  CONTINUE 

ELSE 

WRITE(4 , 615)  KK, EVAL(KK) , EVAL(KK+N) 

WRITE(4 , *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

DO  730  J  =  1,  N 

WRITE(4 , 620)  EVEC(J,KK) ,EVEC( J+N.KK) 

730  CONTINUE 
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END  IF 

IF(EVAL<KK+N)  .EQ.  0.0)  THEN 
VRITE(*,605)  KK, EVAL(KK) 

WRITE(*,*)  '  ' 

WRITE (*,*)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 
WRITE (*,*)  '  ' 

DO  740  J  =  1,  N 

WRITE(*, *)  EVEC(J,KK) 

740  CONTINUE 

ELSE 

WRITE(*,615)  KK, EVAL(KK) , EVAL(KK+N) 

WRITE(* , *)  'AND  THE  ASSOCIATED  EIGENVECTOR  IS' 

DO  750  J  =  1,  N 

WRITE(*, 620)  EVEC( J , KK) , EVEC( J+N,KK) 

750  CONTINUE 

END  IF 

IF(EVAL(KK+N)  .NE.  0.0)  THEN 
WRITE(*,16) 

WRITE(*,17)  KK 
IF(DIARY)  WRITE(4, 16) 

IF(DIARY)  WRITE(4, 17)  KK 
READ(*,*)  EVAL(KK) 

IF(DIARY)  THEN 

VRITE(4, 21)  EVAL(KK) 

WRITE (4,*)  'THE  IMAGINARY  PART  -  ?' 

END  IF 

WRITE(*,*)  'THE  IMAGINARY  PART  .  ?' 

READ(*,*)  EVAL(KK+N) 

IF(DIARY)  THEN 

WRITE(4 , 21)  EVAL(KK+N) 

WRITE(4 , *)  '  ' 

WRITE(4 , * )  'FOR  THE  CORRESPONDING  EIGENVECTOR’ 
END  IF 

WRITE(* , * )  '  ' 

WRITE(*, *)  'FOR  THE  CORRESPONDING  EIGENVECTOR' 

DO  760  I  =  1 , N 
WRITE (*, 34) 

WRITE(*,35)  I 
IF(DIARY)  WRITE(4, 34) 

IF(DIARY)  WRITE(4, 35)  I 
READ(*, *)  EVEC(I ,KK) 

IF(DIARY)  THEN 

WRITE(4,21)  EVEC(I,KK) 

WRITE(4 , *)  'THE  IMAGINARY  PART  =  ?' 

END  IF 

WRITE( * , *)  'THE  IMAGINARY  PART  =  ?' 

READ(*,*)  EVEC(I+N,KK) 

IF(DIARY)  WRITE(4, 21 )  EVEC(I+N,KK) 

760  CONTINUE 

ELSE 

WRITE( * , 105)  KK 
IF(DIARY)  WRITE(4 , 105)  KK 
READ(*,*)  EVAL(KK) 


IF(DIARY)  THEN 

URITE(4, 21)  EVAL(KK) 

WRITE (4,*)  'FOR  THE  CORRESPONDING  EIGENVECTOR, 
END  IF 

WRITE(*,*)  'FOR  THE  CORRESPONDING  EIGENVECTOR,' 

DO  770  I  =  1 ,N 

VRITE(* , 115)  I 
IF(DIARY)  VRITE(4, 115)  I 
READ(*, *)  EVEC(I,KK) 

IF(DIARY)  VRITE(4, 21)  EVEC(I,KK) 

CONTINUE 
END  IF 

IF(DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE(4 , *)  'NOW' 

WRITE(4 , *)  '  ' 

WRITE(4, *)  '  ' 


END  IF 

% 

WRITE(*, *)  '  ' 

•4m  * 

WRITE(* , *)  'NOW' 

/ 

"V 

WRITE ( * , *)  '  ' 

i 

m 

A  ' 

WRITE(* , *)  '  ' 

GO  TO  600 

r 

Z-y. 

999  WRITE(* , * )  '  ' 

.* 

WRITE(*,*)  '  ' 

IF(DIARY)  THEN 
WRITE(4 , * )  '  ' 

WRITE(4 , *)  '  ' 

END  IF 
RETURN 
END 

C********************************************************************* | 

SUBROUTINE  EIGV(A, Z , WR, WI ,NMAX,N, DIARY) 

C  I 

C  CALCULATES  THE  EIGENSTRUCTURE  OF  A  j 

C********************************************************************* | 

REAL  A(NMAX,N) , Z(NMAX,N) , WR(N) , WI(N) , SCALE( 15) , H( 15 , 15) 

INTEGER  INT( 15) 

LOGICAL  DIARY 

CALL  COPYAB(NMAX,N,N, A,H) 

CALL  BALANC ( NMAX , N , H , LOW , IGH , SCALE ) 

CALL  ELMHES(NMAX, N, LOW, IGH, H, INT) 

CALL  ELTRAN(NMAX , N , LOW , IGH , H , INT , Z ) 

CALL  HQR2 ( NMAX , N , LOW , IGH , H , WR , WI , Z , I ERR ) 

CALL  BALBAK(NMAX , N , LOW , IGH , SCALE , N , Z ) 

IF(IERR  .NE.  0)  THEN 

WRITE( * , *)  ' ***WARNING***WARNING***WARNING***WARNING*** ' 
WRITE(*,*)  'NO  CONVERGENCE  REACHED  WHEN  CALCULATING  THE  EIGEN 
+ STRUCTURE’ 

WRITE( * , * )  ' ***WARNING***WARNING***WARNING***VARNING*** ’ 
IF(DIARY)  THEN 

WRITE(4 , *)  ' ***WARNING***WARNING***WARNING***WARNING*** ' 

WRITE( 4 , * )  'NO  CONVERGENCE  REACHED  WHEN  CALCULATING  THE  EIGEN 
+ STRUCTURE' 
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WRITE(4,*)  ' ***WARNING***WARNING***WARNING***WARNING*** ' 

END  IF 
END  IF 
RETURN 
END 

c* j 

SUBROUTINE  ELMHES  ( NM , N , LOW , IGH , A , INT ) 

C  I 

C  TO  REDUCE  A  REAL  GENERAL  MATRIX  TO  UPPER  HESSENBERG  FORM  j 

C  USING  ELEMENTARY  TRANSFORMATIONS  | 

C************************* *********** ********************************** j 
INTEGER  I,J,M,N,LA,NM, IGH ,  KP1 , LOW , MM1 , MP1 
REAL  A(NMf N) 

REAL  X, Y 
REAL  ABS 
INTEGER  INT (IGH) 

C 

LA  *  IGH  -  1 
KP1  =  LOW  +  1 

IF  (LA  .LT.  KP1)  GO  TO  200 
C 

DO  180  M  =  KPl,  LA 
MM1  -  M  -  1 
X  =  0.0 
I  =  M 
C 

DO  100  J  =  M,  IGH 

IF  (ABS(A(J,MM1) )  .LE.  ABS(X))  GO  TO  100 
X  -  A(J,MM1) 

I  =  J 

100  CONTINUE 
C 

INT(M)  =  I 

IF  (I  .EQ.  M)  GO  TO  130 

C  **********  INTERCHANGE  ROWS  AND  COLUMNS  OF  A  ********** 

DO  110  J  -  MM1,  N 

Y  -  A(I,J) 

A(I,J)  »  A(M, J) 

A(M, J)  =  Y 

110  CONTINUE 

C 

DO  120  J  =  1,  IGH 

Y  -  A(J,I) 

A( J , I)  *=  A(J,M) 

A(J,M)  *  Y 
120  CONTINUE 

C  **********  END  INTERCHANGE  ********** 


IF  (X  .EQ.  0.0)  GO  TO  180 
MP1  *  M  +  1 

DO  160  I  =  MP1,  IGH 

Y  =  A ( I ,MM1) 

IF  (Y  .EQ.  0.0)  GO  TO  160 

Y  »  Y  /  X 
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A(I,MM1)  -  Y 


DO  140  J  -  M,  N 

140  A(I,J)  -  A(I,J)  -  Y  *  A(M,J) 
DO  150  J  -  1,  IGH 

150  A(J,M)  =  A(J,M)  +  Y  *  A(J,I) 
160  CONTINUE 


180  CONTINUE 
C 

200  RETURN 
END 

c ★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★ | 

SUBROUTINE  ELTRAN ( NM , N , LOV , IGH , A , INT , 2 ) 

i 

TO  ACCUMULATE  THE  TRANSFORMATIONS  IN  THE  REDUCTION  OF  A  REAL  | 
GENERAL  MATRIX  BY  ELMHES  | 

********************************************************************** | 
INTEGER  I , J , N , KL , MM , MP , NM , IGH , LOW , MP1 
REAL  A(NM, IGH) , Z(NM,N) 

INTEGER  INT (IGH) 

**********  INITIALIZE  Z  TO  IDENTITY  MATRIX  ********** 

DO  80  I  -  1,  N 


DO  60  J  *  lt  N 
60  Z(I,J)  -  0.0 

-i 

Z(I,I)  -  1.0 
80  CONTINUE 

't 

✓ 

KL  a  IGH  -  LOW  -  1 
IF  (KL  .LT.  1)  GO  TO  200 

;  **********  FOR  MP-IGH-1  STEP  -1  UNTIL  LOV+1  DO  —  ********** 

DO  140  MM  -  1,  KL 
MP  -  IGH  -  MM 
MP1  a  MP  +  1 

-> 

DO  100  I  -  MP1,  IGH 
100  Z(I , MP)  «  A(I,MP-1) 

•* 

I  -  INT(MP) 

IF  (I  .EQ.  MP)  GO  TO  140 

j 

DO  130  J  *  MP,  IGH 
Z(MP, J)  -  Z(I,J) 

Z(I,J)  *  0.0 
130  CONTINUE 

* 

./ 

Z(I,MP)  =  1.0 
140  CONTINUE 


200  RETURN 
END 

SUBROUTINE  FACTOR(A,V,IPIVOT,D,N,IFLAG,NMAX) 

c  ! 

C  USED  TO  INVERT  A  MATRIX  WITH  SUBROUTINE  SUBST  j 

C** ★****★*★ *★★★*★★**★*★**★★★★★*★★*★***★*★*********★**********★★******* | 

DIMENSION  A(NMAX,N) ,W(NMAX,N) ,IPIVOT(N) ,D(N) 

I FLAG  -  1 
C 

C  INITIALIZE  V,  I PIVOT,  AND  D 
C 

DO  10  I  -  1,  N 
IPIVOT(I)  =  I 
ROUMAX  -  0. 

DO  9  J  *  1,  N 

ROVMAX  -  AMAX1(R0VMAX, ABS(V(I , J) ) ) 

9  CONTINUE 

IF  (ROVMAX  .EQ.  0.)  GO  TO  999 
D(I)  =  ROVMAX 

10  CONTINUE 
C 

C  GAUSS  ELIMINATION  VITH  SCALED  PARTIAL  PIVOTING 
C 

NM1  -  N  -  1 

IF  (NM1  .EQ.  0)  RETURN 
DO  20  K  -  1,  NM1 
J  «  K 
KP1  «  K+l 
IP  *  IPIVOT(K) 

COLMAX  -  ABS(V(IP,K))/D(IP) 

DO  11  I  -  KP1,  N 
IP  -  IPIVOT(I) 

AVIKOV  -  ABS(V(IP,K) )/D(IP) 

IF  (AVIKOV  .LE.  COLMAX)  GO  TO  11 
COLMAX  .  AVIKOV 
J  -  I 

11  CONTINUE 

IF  (COLMAX  .EQ.  0.)  GO  TO  999 
IPK  -  IPIVOT(J) 

IPIVOT(J)  «  IPIVOT(K) 

IPIVOT(K)  -  IPK 
DO  20  I  =  KP1,  N 
IP  -  IPIVOT(I) 

V(IP,K)  -  V(IP,K)/V(IPK,K) 

RATIO  =  -V(IP,K) 

DO  20  J  -  KP1,  N 

V(IP,J)  *  RATIO  *  V(IPK, J)  +  V(IP,J) 

20  CONTINUE 

IF  (V(IP,N)  .EQ.  0.)  GO  TO  999 
RETURN 

999  I FLAG  «  2 
RETURN 
END 
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SUBROUTINE  HQR2 ( NM , N , LOV , IGH  f H , VR , VI , Z , IERR ) 

C  I 

C  COMPUTES  THE  EIGENVALUS  AND  EIGENVECTORS  OF  A  REAL  UPPER  1 


C  HESSENBERG  MATRIX 

INTEGER  I,J,K,L,M,N,EN,II,JJ,LL,MM,NA,NM,NN, 

X  IGH , ITS , LOW , MP2 , ENM2 ,  IERR 

REAL  H(NM,N),VR(N),VI(N),Z(NM,N) 

REAL  P,Q,R,S,T,V,X,Y,RA,SA,VI,VR,ZZ, NORM , MACHEP 

REAL  SORT, ABS, SIGN 

INTEGER  MINO 

LOGICAL  NOTLAS 

COMPLEX  Z3 

COMPLEX  CMPLX 

REAL  REAL, AIMAG 


C 

C 

C 

C 

C 


**********  MACHEP  IS  A  MACHINE  DEPENDENT  PARAMETER  SPECIFYING 
THE  RELATIVE  PRECISION  OF  FLOATING  POINT  ARITHMETIC. 


MACHEP 


l.E-8 


IERR  -  0 
NORM  -  0.0 
K  -  1 

C  **********  STORE  ROOTS  ISOLATED  BY  BALANC 
C  AND  COMPUTE  MATRIX  NORM  ********** 

DO  50  I  -  1,  N 


DO  40  J  *  K,  N 

40  NORM  =  NORM  +  ABS(H(I,J)) 


IF  (I  .GE.  LOV  .AND.  I  .LE.  IGH)  GO  TO  50 

VR(I)  -  H(I,I) 

VI(I)  =  0.0 

» ■ 

50 

CONTINUE 

&■  C 

L » 

EN  -  IGH 

* 

T  =  0.0 

**********  SEARCH  FOR  NEXT  EIGENVALUES  ********** 

r, 

s. 

60 

IF  (EN  .LT.  LOV)  GO  TO  340 

f. 

ITS  -  0 

S. 

f. 

NA  =  EN  -  1 

s. 

f*»  p 

i  c 

ENM2  -  NA  -  1 

**********  LOOK  FOR  SINGLE  SMALL  SUB-DIAGONAL  ELEMENT 

FOR  L«EN  STEP  -1  UNTIL  LOV  DO  —  ********** 

.*• 

70 

DO  80  LL  -  LOV,  EN 

* 

L  *  EN  +  LOV  -  LL 

■ 

IF  (L  .EQ.  LOV)  GO  TO  100 

£ 

S  «  ABS(H(L-1 , L-l) )  +  ABS(H(L,L)) 

ft 

IF  (S  .EQ.  0.0)  S  *  NORM 

& 
*  V 


IF  (ABS(H(L,L-1))  .LE.  MACHEP  *  S)  GO  TO  100 
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V.V 

I  * 

S'"  rj 


jbi 


>Ai  Li 


u 

»* 

777 

v‘:\ 


o  n  n  n  o  o  o 


80  CONTINUE 

C  **********  FORM  SHIFT  ********** 

100  X  -  H(EN, EN) 

IF  (L  .EQ.  EN)  GO  TO  270 

Y  -  H(NA,NA) 

tf  -  H ( EN , NA )  *  H(NA,EN) 

IF  (L  .EQ.  NA)  GO  TO  280 
IF  (ITS  .EQ.  30)  GO  TO  1000 
IF  (ITS  .NE.  10  .AND.  ITS  .NE.  20)  GO  TO  130 
C  **********  FORM  EXCEPTIONAL  SHIFT  ********** 

T  -  T  +  X 
C 

DO  120  I  -  LOW,  EN 
120  H(I,I)  -  H(I,I)  -  X 
C 

S  -  ABS(H(EN,NA) )  +  ABS(H(NA, ENM2) ) 

X  -  0.75  *  S 

Y  -  X 

W  -  -0.4375  *  S  *  S 
130  ITS  -  ITS  +  1 

**********  LOOK  FOR  TWO  CONSECUTIVE  SMALL 
SUB-DIAGONAL  ELEMENTS. 

FOR  M-EN-2  STEP  -1  UNTIL  L  DO  —  ********** 

DO  140  MM  -  L,  ENM2 
M  -  ENM2  +  L  -  MM 
ZZ  -  H(M,M) 

R  -  X  -  ZZ 
S  =  Y  -  ZZ 

P  -  (R  *  S  -  W)  /  H(M+1,M)  +  H(M,M+1) 

Q  -  H(M+1 , M+l )  -  ZZ  -  R  -  S 
R  »  H(M+2,M+1) 

S  -  ABS(P)  +  ABS(Q)  +  ABS(R) 

P  -  P  /  S 
Q  «  Q  /  S 
R  -  R  /  S 

IF  (M  .EQ.  L)  GO  TO  150 

IF  (ABS(H(M,M-1) )  *  (ABS(Q)  +  ABS(R) )  .LE.  MACHEP  *  ABS(P) 

X  *  (ABS(H(M-1,M-1))  +  ABS(ZZ)  +  ABS(H(M+1 ,M+1) ) ) )  GO  TO  150 
140  CONTINUE 

150  MP2  -  M  +  2 

DO  160  I  -  MP2,  EN 
H(I,I-2)  -  0.0 
IF  (I  .EQ.  MP2)  GO  TO  160 
H(I,I-3)  .  0.0 
160  CONTINUE 

**********  DOUBLE  QR  STEP  INVOLVING  ROWS  L  TO  EN  AND 
COLUMNS  M  TO  EN  ********** 

DO  260  K  -  M,  NA 

NOTLAS  -  K  .NE.  NA 
IF  (K  .EQ.  M)  GO  TO  170 
P  »  H(K,K-1) 

Q  -  H(K+1 ,K-1) 


R  -  0.0 

IF  (NOTLAS)  R  =  H(K+2,K-1) 

X  -  ABS(P)  +  ABS(Q)  +  ABS(R) 

IF  (X  .EQ.  0.0)  GO  TO  260 
P  -  P  /  X 
Q  «  Q  /  X 
R  -  R  /  X 

170  S  -  SIGN(SQRT(P*P+Q*Q+R*R),P) 

IF  (K  .EQ.  M)  GO  TO  180 
H(K,K-1)  -  -S  *  X 
GO  TO  190 

180  IF  (L  .NE.  M)  H(K,K-1)  =  -H(K,K-1) 

190  P  -  P  +  S 

X  «  P  /  S 
Y  =.  Q  /  S 
ZZ  »  R  /  S 
0  =  Q  /  P 
R  -  R  /  P 

C  **********  row  MODIFICATION  ********** 

DO  210  J  -  K,  N 

P  -  H(K, J)  +  Q  *  H(K+1, J) 

IF  (.NOT.  NOTLAS)  GO  TO  200 
P  «  P  ♦  R  *  H(K+2, J) 

H(K+2, J)  -  H(K*2,J)  -  P  *  ZZ 

200  H(K+1 , J)  -  H(K+1 , J)  -  P  *  Y 

H(K,J)  -  H(K, J)  -  P  *  X 

210  CONTINUE 

C 

J  =  MIN0(EN,K+3) 

C  **********  COLUMN  MODIFICATION  ********** 

DO  230  I  -  1,  J 

P  *  X  *  H(ItK)  +  Y  *  H(I ,K+1) 

IF  (.NOT.  NOTLAS)  GO  TO  220 
P  -  P  +  ZZ  *  H(I,K+2) 

H(I ,K+2)  -  H(I ,K+2)  -  P  *  R 
220  H(I ,K+1)  -  H(I ,K+1)  -  P  *  Q 

H(I,K)  -  H(I,K)  -  P 
230  CONTINUE 

C  **********  ACCUMULATE  TRANSFORMATIONS  ********** 

DO  250  I  *  LOW,  IGH 

P  *  X  *  Z(I,K)  +  Y  *  Z(I,K*1) 

IF  (.NOT.  NOTLAS)  GO  TO  240 
P  *  P  +  ZZ  *  Z(I ,K+2) 

Z(I ,K+2)  -  Z(I ,K+2)  -  P  *  R 
240  Z(I,K+1)  -  Z(I,K*1)  -  P  *  0 

Z(I,K)  -  Z(I,K)  -  P 
250  CONTINUE 


& 

v 


260  CONTINUE 
GO  TO  70 

**********  ONE  ROOT  FOUND  ********** 
270  H(EN,EN)  -  X  +  T 
VR(EN)  ,  H(EN, EN) 
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WI(EN)  -  0.0 
EN  -  NA 
GO  TO  60 

C  **********  TWO  ROOTS  FOUND  ********** 

280  P  -  (Y  -  X)  /  2.0 
Q  .  P  *  P  +  V 
12  -  SQRT(ABS(Q) ) 

H(EN,EN)  =  X  +  T 
X  -  H(EN,EN) 

H(NA,NA)  -  Y  +  T 

IF  (Q  .LT.  0.0)  GO  TO  320 

Q  ★★★★★★★★★★  REAL  PAIR  ********** 

ZZ  «  P  +  SIGN(ZZ, P) 

VR(NA)  «=  X  +  ZZ 
WR(EN)  -  WR(NA) 

IF  (ZZ  .NE.  0.0)  WR(EN)  -  X  -  V  /  ZZ 
VI(NA)  -  0.0 
WI(EN)  -  0.0 
X  -  H(EN,NA) 

S  -  ABS(X)  +  ABS(ZZ) 

P  -  X  /  S 

Q  -  ZZ  /  S 

R  -  SQRT(P*P+Q*Q) 

P  ■  P  /  R 
Q  -  Q  /  R 

c  **********  ROW  MODIFICATION  ********** 

DO  290  J  -  NA,  N 
ZZ  -  H ( NA , J ) 

H(NA, J)  «  Q  *  ZZ  +  P  *  H(EN, J) 

H(EN, J)  .  Q  *  H(EN, J)  -  P  *  ZZ 
290  CONTINUE 

C  **********  COLUMN  MODIFICATION  ********** 

DO  300  I  -  1,  EN 
ZZ  -  H ( I , NA ) 

H ( I , NA )  -  Q  *  ZZ  +  P  *  H(I,EN) 

H(I,EN)  -  Q  *  H(I,EN)  -  P  *  ZZ 
300  CONTINUE 

C  **********  ACCUMULATE  TRANSFORMATIONS  ********** 

DO  310  I  ■  LOW,  IGH 
ZZ  *  Z(I,NA) 

Z ( I , NA )  »  Q  *  ZZ  +  P  *  Z(I,EN) 

Z(I , EN)  m  Q  *  Z(I ,EN)  -  P  *  ZZ 
310  CONTINUE 

C 

GO  TO  330 

C  **********  COMPLEX  PAIR  ********** 

320  WR(NA)  -  X  +  P 
WR(EN)  -  X  +  P 
WI(NA)  -  ZZ 
UI(EN)  -  -ZZ 
330  EN  -  ENM2 
GO  TO  60 

**********  ALL  ROOTS  FOUND.  BACKSUBSTITUE  TO  FIND 

VECTORS  OF  UPPER  TRIANGULAR  FORM  ********** 
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IP  (NORM  .EQ.  O.O)  GO  TO  1001 
**********  FOR  EN-N  STEP  -1  UNTIL  1  DO¬ 
DO  800  NN  -  1,  N 
EN  -  N  +  1  -  NN 
P  -  VR(EN) 

Q  -  VI (EN) 

NA  -  EN  -  1 

IF  (Q)  710,  600,  800 

**********  real  vector  ********** 

M  *  EN 

H(EN,EN)  =  1.0 
IF  (NA  .EQ.  0)  GO  TO  800 
**********  fo  I-EN-1  STEP  -1  UNTIL  1  DO 
DO  700  II  -  1,  NA 
I  *  EN  -  II 
V  -  H(I,I)  -  P 
R  -  H(I , EN) 

IF  (M  .GT.  NA)  GO  TO  620 


_ 


DO  610  J  .  M,  NA 
R  »  R  +  H(I , J)  *  H(J,EN) 


IF  (VI(I)  .GE.  0.0)  GO  TO  630 
ZZ  -  V 
S  -  R 
GO  TO  700 

M  -  I 

IF  (VI(I)  .NE.  0.0)  GO  TO  640 


T  -  V 

IF  (V  .EQ.  0.0)  T  -  MACHEP  *  NORM 
H(I ,EN)  -  -R  /  T 
GO  TO  700 

**********  SOLVE  REAL  EQUATIONS  ********** 

X  -  H(I,I+1) 

Y  -  H(I+1,I) 

Q  -  (VR(I)  -  P)  *  (VR(I)  -  P)  +  VI(I)  *  VI(I) 

T  -  (X  *  S  -  ZZ  *  R)  /  Q 
H(I ,EN)  -  T 

IF  (ABS(X)  .LE.  ABS(ZZ))  GO  TO  650 
H(I+1 , EN)  «  (-R  -  y  *  T)  /  X 
GO  TO  700 

H(I+1 , EN)  .  (-S  -  Y  *  T)  /  ZZ 
CONTINUE 

**********  END  REAL  VECTOR  ********** 

GO  TO  800 

**********  COMPLEX  VECTOR  ********** 

M  »  NA 

**********  LAST  VECTOR  COMPONENT  CHOSEN  IMAGINARY  SO  THAT 
EIGENVECTOR  MATRIX  IS  TRIANGULAR  ********** 

IF  (ABS(H(EN,NA) )  .LE.  ABS(H(NA, EN) ) )  GO  TO  720 
H(NA,NA)  -  Q  /  H ( EN , NA ) 

H(NA,EN)  -  -(H(EN,EN)  -  P)  /  H(EN,NA) 

GO  TO  730 

Z3  .  CMPLX(0. 0, -H(NA, EN) )  /  CMPLX(H(NA,NA)-P,Q) 


•  «■>*  «»^* 


V-  JV  '*  u‘"  *'■  »'** 


H(NA,NA)  -  REAL(Z3) 

H(NA,EN)  -  AIMAG(Z3) 

730  H(EN,NA)  -  0.0 
H(EN,EN)  =  1.0 
ENM2  -  NA-1 

IF  (ENM2  .EQ.  0)  GO  TO  800 

C  **********  FOR  I-EN-2  STEP  -1  UNTIL  1  DO  —  ********** 

DO  790  II  >  1,  ENM2 
I  -  NA  -  II 

V  =  H(I,I)  -  P 
RA  =  0.0 

SA  -  H(I ,EN) 

C 

DO  760  J  -  M,  NA 

RA  *  RA  +  H(I,J)  *  H( J,NA) 

SA  =  SA  +  H(I, J)  *  H( J , EN) 

760  CONTINUE 

C 

IF  (WI(I)  .GE.  0.0)  GO  TO  770 
ZZ  =  V 
R  *  RA 
S  -  SA 
GO  TO  790 
770  M  -  I 

IF  (VI(I)  .NE.  0.0)  GO  TO  780 
Z3  *  CMPLX(-RA,-SA)  /  CMPLX(V,Q) 

H ( I , NA )  -  REAL(Z3) 

H(I,EN)  .  AIMAG(Z3) 

GO  TO  790 

C  **********  SOLVE  COMPLEX  EQUATIONS  ********** 

780  X  «  H(I,I+1) 

Y  «  H(I+1 , I ) 

VR  -  (VR(I)  -  P)  *  (VR(I)  -  P)  +  VI(I)  *  VI(I)  -  Q  *  Q 

VI  -  (VR(I)  -  P)  *  2.0  *  Q 

IF  (VR  .EQ.  0.0  .AND.  VI  .EQ.  0.0)  VR  -  MACHEP  *  NORM 
X  *  (ABS(V)  +  ABS(Q)  ♦  ABS(X)  +  ABS(Y)  +  ABS(ZZ)) 

Z3  -  CMPLX(X*R-ZZ*RA+Q*SA,X*S-ZZ*SA-Q*RA)  /  CMPLX(VR,VI) 
H(I ,NA)  *  REAL(Z3) 

H(I,EN)  »  AIMAG(Z3) 

IF  (ABS(X)  .LE.  ABS(ZZ)  +  ABS(Q) )  GO  TO  785 
H(I+1,NA)  -  (-RA  -  V  *  H(I,NA)  +  Q  *  H(I,EN))  /  X 

H(I+1 ,EN)  -  (-SA  -  V  *  H(I,EN)  -  Q  *  H(I,NA))  /  X 

GO  TO  790 

785  Z3  =  CMPLX(-R-Y*H(I ,NA) , -S-Y*H(I , EN) )  /  CMPLX(ZZ,Q) 

H(I+1 ,NA)  -  REAL(Z3) 

H(I+1, EN)  *  AIMAG(Z3) 

790  CONTINUE 

C  **********  END  COMPLEX  VECTOR  ********** 

800  CONTINUE 

C  **********  END  BACK  SUBSTITUTION. 

C  VECTORS  OF  ISOLATED  ROOTS  ********** 

DO  840  I  *  1,  N 

IF  (I  .GE.  LOW  .AND.  I  .LE.  IGH)  GO  TO  840 
C 


DO  820  J  =  I,  N 
820  Z(I,J)  =  H(I, J) 


I 


V 
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840  CONTINUE 

**********  MULTIPLY  BY  TRANSFORMATION  MATRIX  TO  GIVE 
VECTORS  OF  ORIGINAL  FULL  MATRIX. 

FOR  J-N  STEP  -1  UNTIL  LOW  DO  —  ********** 
DO  880  JJ  =  LOW,  N 
J  *  N  +  LOW  -  JJ 
M  -  MINO( J , IGH) 


DO  880  I  =  LOW, 
ZZ  =  0.0 


IGH 


860 


DO  860  K  4  LOW,  M 

ZZ  *  ZZ  +  Z(I,K)  *  H(K, J) 


Z(I,J)  =  ZZ 
880  CONTINUE 


GO  TO  1001 

**********  SET  ERROR 


NO  CONVERGENCE  TO  AN 
C  EIGENVALUE  AFTER  30  ITERATIONS  ********** 

1000  I  ERR  »  EN 

1001  RETURN 
END 

Q********************************************************************* | 

SUBROUTINE  INPUTA<NMAX(N,M,A, DIARY) 


'DO  YOU  WANT  TO  USE  A  NEW  MATRIX  ENTERED  FROM  THE' 
' KEYBOARD ,  OR  ONE  ALREADY  STORED  ON  THE  COMPUTER?’ 


THIS  SUBROUTINE  READS  IN  ANY  NXM  MATRIX  CALLED  A 
THE  PARAMETERS  N  AND  M  ARE  PASSED  TO  IT 
AND  THIS  SUBROUTINE  PASSES  BACK  THE  MATRIX  A 

C****************************************** *************************** 

REAL  A(NMAX,M) 

LOGICAL  ANSWER, KBRD, DIARY 
CHARACTER  TEST*1 , FILEI*14 
WRITE(*, *)  '  ' 

WRITE(*,*) 

1  WRITE(*,*) 

WRITE(*,*) 

WRITE(*, *) 

WRITE(* , *) 

IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

VRITE(4, *) 

WRITE(4,*) 

URITE(4, *) 

WRITE(4,*) 

WRITE(4 , *) 

END  IF 

READ(* , ' ( A1 ) ' )  TEST 
IF(DIARY)  WRITE(4, *)  TEST 

KBRD  -  <(LLE(TEST,'K')  .AND.  LGE(TEST, ' K' ) )  .OR. 

+(LLE(TEST,'k')  .AND.  LGE(TEST, ' k' ) ) ) 


’ENTER: 


K  FOR  KEYBOARD 


OR 


C  FOR  COMPUTER' 


'DO  YOU  WANT  TO  USE  A  NEW  MATRIX  ENTERED  FROM  THE' 
'KEYBOARD,  OR  ONE  ALREADY  STORED  ON  THE  COMPUTER?' 


’ENTER: 


K  FOR  KEYBOARD 


OR 


C  FOR  COMPUTER' 
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c 

c 


20 

30 


40 


50 

60 


IF  (KBRD)  GO  TO  2 

IF((LLT(TEST, 'C' )  .OR.  LGT(TEST, 'C' ))  AND 

VRITE(*’*)  '  ' 

VRITE(*,*)  '  ' 

IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

VRITE(4, *)  '  ' 

VRITE(4, *)  '  ' 

END  IF 
GO  TO  200 

OPTION  1:  ENTERING  DATA  FROM  THE  KEYBOARD 
VRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

IF(DIARY)  THEN 
VRITE(4,*)  '  ' 

VRITE(4, *)  '  ' 

END  IF 
DO  30  I.1,N 

DO  20  J*1,M 
VRITE(*,3)  I,J 
IF(DIARY)  VRITE(4,3)  I,J 
FORMAT( IX, 'ENTER  THE  ELEMENT  OF  ROW 
READ(*, *)  A(I , J) 

IF(DIARY)  VRITE(4,5)  A(I, J) 

FORMAT( IX, F15. 7 ) 

CONTINUE 
CONTINUE 
IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

WRITE(4, *)  '  ' 

END  IF 

VRITE(*, *)  '  ' 

WRITE(*, *)  >  * 

VRITE(*,*)  'THE  MATRIX  IS  GIVEN  AS' 
nn<SA?Yi)  !JRITE(4’*>  'THE  MATRIX  IS  GIVEN  AS' 

U{J  oU  1*1,N 

WRITE(*,50)  (A( I , J) , J=1 , M) 

VRITE(*,*)  '  ' 

IF(DIARY)  THEN 

WRITE(4 , 50)  (A(I, J), J„1,M) 

VRITE(4, *)  '  ' 

END  IF 

FORMAT(5F15. 7) 

CONTINUE 
WRITE(*, *)  '  ' 

VRITE(*, *)  'IS  THIS  MATRIX  CORRECT’' 

IF(DIARY)  THEN 
VRITE(4, ★)  '  ' 

VRITE(4,*)  'IS  THIS  MATRIX  CORRECT’ ' 

END  IF 


,12,'  AND  COLUMN  ',12) 


.v.H 


ar 


r. 


f  -.1 

b. 
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CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  GO  TO  999 

70  WRITE(*,*)  'WHICH  ROW  HAS  AN  INCORRECT  ENTRY?' 

IF(DIARY)  WRITE(4, *)  'WHICH  ROW  HAS  AN  INCORRECT  ENTRY?' 
READ(*,80)  K 
80  FORMAT (12) 

IF (DIARY)  THEN 
WRITE(4,*)  K 

WRITE(4, *)  'WHICH  COLUMN  HAS  AN  INCORRECT  ENTRY?' 

END  IF 

WRITE(* ,*)  'WHICH  COLUMN  HAS  AN  INCORRECT  ENTRY?' 

READ(*,90)  L 
90  FORMAT (12) 

IF (DIARY)  THEN 
WRITE(4,*)  L 

WRITE (4,*)  'THE  CURRENT  VALUE  OF  A( ' ,K, ' , ' ,L, ' )  IS  ',A(K,L) 
WRITE (4,*)  'ENTER  THE  CORRECT  VALUE' 

END  IF 

WRITE(* , * )  'THE  CURRENT  VALUE  OF  A(' ,K, ' , ' ,L, ' )  IS  ' ,A(K,L) 
WRITE (*,*)  'ENTER  THE  CORRECT  VALUE' 

READ(*,*)  A(K,L) 

IF (DIARY)  THEN 

WRITE(4,*)  A(K, L) 

WRITE(4 , * )  '  ' 

WRITE(4, *)  'NOW' 

WRITE(4, *)  '  ' 

WRITE(4 , *)  '  ' 

END  IF 

WRITE(* ,  *)  '  ' 

WRITE(*, *)  'NOW' 

WRITE(*, *)  '  ' 

WRITE(*, *)  '  ' 

GO  TO  40 


OPTION  2:  ENTERING  DATA  FROM  AN  EXISTING  COMPUTER  DATA  FILE 


200  WRITE (*,*) 'WHAT  IS  THE  INPUT  FILE  NAME?' 

IF(DIARY)  WRITE (4,*) 'WHAT  IS  THE  INPUT  FILE  NAME?' 
READ(* , ' (A) ' )  FI LEI 
IF(DIARY)  WRITE(4,*)  FILEI 
0PEN(3, FILE-FILEI , STATUS*' OLD' ) 

REWIND  3 

READ(3,*,ERR-210, END-220)  ( (A(I, J) , J-l , M) , 1-1 ,N) 

GO  TO  230 

210  WRITE(6,*)  ' ***ERROR  IN  INPUT  FILE***' 

IF(DIARY)  WRITE(4,*)  '***ERROR  IN  INPUT  FILE***' 

GO  TO  200 

220  WRITE(6 , *)  '***ERROR:  END  OF  FILE  REACHED***' 

IF(DIARY)  WRITE(4,*)  '***ERROR:  END  OF  FILE  REACHED***' 
GO  TO  200 
230  CL0SE(3) 

WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

WRITE( * , *)  'THE  MATRIX  READ  IS' 


o  n 


'THE  MATRIX  READ  IS' 


WRITE(*,*)  '  ' 

IF(DIARY)  THEN 
WRITE (4,*)  ' 

WRITE(4,*) 

WRITE(4,*) 

WRITE(4, *) 

END  IF 

DO  250  1=1, N 

WRITE(* , 240)  (A(I , J) , J=1 , M) 

WRITE(*, *)  '  ' 

IF( DIARY)  THEN 

WRITE(4,240)  (A(I, J) ,J=1,M) 

WRITE(4, *)  '  ' 

END  IF 

240  FORMAT(5F15 .7) 

250  CONTINUE 

WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*,*)  'IS  THIS  THE  DESIRED  MATRIX?' 

IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE(4,*)  '  ' 

URITE(4,*)  'IS  THIS  THE  DESIRED  MATRIX?' 

END  IF 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  GO  TO  999 

WRITE(*,*)  'DO  YOU  WANT  TO  EDIT  THIS  MATRIX,' 

WRITE(*,*)  'OR  ENTER  A  NEW  MATRIX?' 

’DO  YOU  WANT  TO  EDIT  THIS  MATRIX,' 
'OR  ENTER  A  NEW  MATRIX?' 


N  FOR  NEW' 


N  FOR  NEW' 


.AND.  LGE(TEST, 'E' ) 
LGT(TEST, 'N' ) )  GO  TO  260 


IF( DIARY)  WRITE(4 , * ) 

IF(DIARY)  WRITE(4, *) 

260  WRITE(*,*)  'ENTER:  E  TO  EDIT  OR 

READ(* , ' ( Al ) ' )  TEST 
IF(DIARY)  THEN 

WRITE (4,*)  'ENTER:  E  TO  EDIT  OR 

WRITE (4,*)  TEST 
END  IF 

KBRD  «  LLE(TEST, 'E' ) 

IF  (KBRD)  GO  TO  70 
IF(LLT(TEST, 'N' )  .OR. 

GO  TO  1 

999  WRITE(* , *)  '  ' 

WRITE(*,*)  '  ' 

IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

WRITE(4,*)  '  ' 

END  IF 
RETURN 
END 

SUBROUTINE  INVERT ( A, AINV.N, DIARY) 
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CALLS  SUBROUTINES  FACTOR  AND  SUBST  TO  INVERT  A  MATRIX  | 

Qit  ★★★★★★★★★★ | 

REAL  AA( 15, 15) , AINV( 15,N) ,B(15),A(15,N) 


>. 

v. 
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INTEGER  IPIVOT( 15) 

LOGICAL  DIARY 
DO  10  I  =  1,  N 
DO  10  J  *  1,  N 

AA(I, J)  =  A(I,J) 

10  CONTINUE 

CALL  FACTOR(AA,AA,IPIVOT,B,N, IFLAG, 15) 

GO  TO  (30, 20) IFLAG 
20  WRITE (*, *)  'MATRIX  IS  SINGULAR' 

IF (DIARY)  WRITE(4,*)  'MATRIX  IS  SINGULAR' 

RETURN 

30  DO  40  I  =  1,  N 
B(I )  =  0. 

40  CONTINUE 

DO  50  J  =  1,  N 
B( J)  =  1. 

CALL  SUBST(AA, B, AINV(1 , J) , IPIVOT ,N, 15) 

B( J)  =  0. 

50  CONTINUE 

WRITE(*,*)  '  ' 

WRITE(* , * )  '  ' 

IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

VRITE(4,*)  '  ' 

END  IF 
RETURN 
END 

C************************************ *************** ****************** | 
SUBROUTINE  PACHDF(PA, PACH, NMAX, N,M,K) 

C  I 

C  DEFINES  PACK  FROM  PA  | 

C* ************************ *********** ********************************* | 

REAL  PACH ( NMAX , M ) , P A ( NMAX ) 

DO  10  I  *  1,  N 

PACH ( I , K)  -  PA( I ) 

10  CONTINUE 
RETURN 
END 

************* *** ******* ****** ************** | 
SUBROUTINE  PDDEF ( EVEC , PD , NMAX , N , M , K ) 

C  I 

C  DEFINES  THE  DESIRED  EIGENVECTOR  PD  FROM  THE  MATRIX  EVEC  j 

REAL  EVEC(NMAX, M) , PD(NMAX)  1 

DO  10  I  =  1,  N 

PD(I)  -  EVEC(I,K) 

10  CONTINUE 
RETURN 
END 

C********************** ************************************ *********** | 

SUBROUTINE  PLOT( XHI STR , KP1 , N , T , NMAX , DI ARY ) 

C  I 

C  PLOTTING  ROUTINE  USING  INPUTS  FROM  SUBROUTINE  SIMUL8  j 

C* **************************** ****** ********************************** 
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REAL  XMAX( 15) , XMIN( 15) , XHISTR( 15,151) 

LOGICAL  ANSWER, DIARY 
CHARACTER* 1  BLANK, PLUS, STAR 
BLANK  -  '  ' 

PLUS  =  '+' 

STAR  =  '*' 

XMAX(I)  IS  THE  LARGEST  VALUE  OF  X(I). 

XMIN(I)  IS  THE  SMALLEST  VALUE  OF  X(I). 

THESE  ARE  USED  TO  SCALE  THE  PLOT  OF  THE  TIME  HISTORY  OF  X(I) 

DO  10  I  «  1,  N 

XMAX(I)  =  XHISTR(I , 1) 

XMIN(I)  -  XHISTR(I, 1) 

10  CONTINUE 

DO  20  I  -  1,  N 

DO  20  J  =  1,  KP1 

XMAX(I)  -  AMAX1(XHISTR(I, J) ,XMAX(I)) 

XMIN(I)  «  AMIN1(XHISTR(I , J) , XMIN(I) ) 

20  CONTINUE 
30  WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

WRITE (*,*)  'WHICH  ELEMENT  OF  THE  STATE  VECTOR  X' 

WRITE (*,*)  'DO  YOU  WANT  PLOTTED?' 

WRITE (*,*)  'ENTER  THE  DESIRED  VALUE  OF  I ,  I  -  1 ,  2 , . . . ,  N, ' 
WRITE(*, *)  'FOR  X(I).' 

READ(*, ' (12) '  )  I 
IF(DIARY)  THEN 
WRITE(4 , *)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4 , *)  '  ' 

WRITE(4 , *)  'WHICH  ELEMENT  OF  THE  STATE  VECTOR  X' 

WRITE (4,*)  'DO  YOU  WANT  PLOTTED?' 

WRITE(4, *)  'ENTER  THE  DESIRED  VALUE  OF  I,  I  =  1,  2,...,  N 
WRITE(4, *)  'FOR  X(I).' 

WRITE(4,*)  I 
WRITE(4,40)  I,XMIN(I) 

WRITE(4,50)  I,XMAX(I) 

WRITE(4,*)  '  ' 

WRITE(4, *)  'NOTE  THAT  THE  SYMBOL  "*"  IS  THE  PLOTTED  VALUE 
WRITE (4,*)  'AND  THE  SYMBOL  SHOWS  THE  LOCATION  OF  ZERO 
WRITE(4, *)  '  ' 

END  IF 

WRITE(*,40)  I,XMIN(I) 

40  F0RMAT(1X, 'XMIN(' ,12, ' )=' ,E12.5) 

WRITE(* , 50)  I ,XMAX(I) 

50  F0RMAT(1X,'XMAX(' ,I2,')=',E12.5) 

WRITE(*,*)  '  ' 

VRITE(*, *)  'NOTE  THAT  THE  SYMBOL  "*"  IS  THE  PLOTTED  VALUE' 
WRITE(*,*)  'AND  THE  SYMBOL  SHOWS  THE  LOCATION  OF  ZERO' 
WRITE( * , * )  '  ' 

DO  60  KT  «  1,  KP1 
TIME  -  (KT-1)  *  T 


IF  (XMAX(I) .GT.O.O)  THEN 
IF  (XMIN(I) . LT.O.O)  THEN 

Qirk'k-k'k'k'kif'k'kit'klt'kirk’k'k'k 

C  CASE  I  (XMIN  <  0  <  XMAX) 

NSTAR  -  NINT ( 69 . 0* ( XHI STR( I ,  KT  ) -XMIN( I ) ) / ( XMAX( I ) - 
+XMIN(I)))+1 

NPLUS  «  NINT(69.0*(0.0-XMIN(I))/(XMAX(I)-XMIN(I) ) )+l 

Q  -k-k'k'k'k'k'k'kirk’kirk'k'kirkirk 

IF  (NSTAR.LT. NPLUS)  THEN 

VRITE(*,'("  "  ,F7.3,70A)')TIME,(BLANK,L-1,NSTAR-1), 
♦STAR, (BLANK, L-l ,NPLUS-NSTAR-1 ) , PLUS 
IF(DIARY)  VRITE(4,'("  "  , F7. 3, 70A) ' )TIME, (BLANK, L=1 , NSTAR- 1 ) , 
♦  STAR , ( BLANK , L- 1 , NPLUS-NSTAR- 1 ) , PLUS 
END  IF 

IF  ( NSTAR. EQ. NPLUS)  THEN 

VRITE(*,'("  "  ,F7.3,70A)' )TIME, (BLANK, L=1 .NSTAR-l ) , 

+STAR 

IF(DIARY)  VRITE(4,'("  "  ,F7. 3, 70A) ' )TIME, (BLANK, L=1 ,NSTAR-1 ) , 
+  STAR 

END  IF 

IF  (NSTAR. GT. NPLUS)  THEN 

WRITE(*, '("  ' ' ,F7.3,70A)' )TIME, (BLANK, L-l .NPLUS-l ) , 
+PLUS, (BLANK, L-l .NSTAR-NFLUS-l) , STAR 
IF(DIARY)  WRITE(4,'("  ' ' , F7 . 3, 70A) ' )TIME, (BLANK, L«1 , NPLUS- 1) , 
+PLUS, ( BLANK , L- 1 , NSTAR-NPLUS- 1 ) , STAR 
END  IF 
END  IF 

IF  (XMIN(I) . EQ.0.0)  THEN 

C******************* 

C  CASE  II  (0  -  XMIN  <  XMAX) 

NSTAR  -  NINT ( 69 . 0* ( XHI STR( I , KT ) -XMIN ( I ) ) / ( XMAX ( I ) - 
+XMIN(I) ) )+l 

NPLUS  -  1 

★★★★★★★★ ★★★★★★★★★★ 

IF  (NSTAR. EQ. NPLUS)  THEN 

WRITE (*, '  ("  ' '  ,F7.3,70A)'  )TIME,STAR 
IF(DIARY)  WRITE(4,'("  ' ' , F7. 3, 70A) ' )TIME, STAR 
ELSE 

VRITE(* , ' (  "  "  , F7 . 3 , 70A ) ' )TIME , PLUS , ( BLANK , L-l , 
♦NSTAR-NPLUS- 1 ) , STAR 

IF(DIARY)  WRITE(4,'("  ",  F7 . 3, 70A) '  )TIME,  PLUS,  (BLANK,  L=1 , 
♦NSTAR-NPLUS- 1 ) , STAR 
END  IF 
END  IF 

IF  (XMIN(I). GT.O.O)  THEN 

Q* ****************** 

IF  (XMIN(I).EQ.XMAX(I))  THEN 
C  CASE  VII  (0  <  XMIN  -  XMAX) 

NSTAR  -  35 
ELSE 

C  CASE  VI  (0  <  XMIN  <  XMAX) 

NSTAR  -  NINT(69 ,0*( XHISTR( I ,KT)/XMAX( I ) ) )+l 
END  IF 

Q'k’kitirkidrkirkit'kirkirirkirk 


VRITE(*, '("  ' ' ,F7. 3, 70A)')TIME, PLUS, (BLANK, L=l, 
+NSTAR-2 ) , STAR 

IF(DIARY)  VRITE(4, '  ( ' '  "  ,F7. 3, 70A)' )TIME, PLUS, (BLANK, L-l, 
♦NSTAR-2 ) , STAR 
END  IF 
END  IF 

IF  (XMAX(I) .EQ.O.O)  THEN 

IF  (XMIN(I) . LT.XMAX(I) )  THEN 

Qit'kieicirkirkirk'kicirkifirk'kic 

C  CASE  III  (XMIN  <  0  -  XMAX) 

NSTAR  -  NINT(69.0*(XHISTR(I ,KT)-XMIN(I) )/(XMAX(I)- 
+XMIN(I)))+1 

NPLUS  -  70 
c**  ★**★★★*★**★*•*★★★★ 

IF  (NSTAR.EQ. NPLUS)  THEN 

WRITE(*, ' ( ' '  ' ' ,F7.3,70A)')TIME,(BLANK,L-1,NSTAR-1), 

♦  STAR 

IF(DIARY)  WRITE(4,'("  "  , F7 . 3 , 70A) ' )TIME, (BLANK, L-l ,NSTAR-1 ) , 
+  STAR 

ELSE 

VRITE(*,'("  ' ' ,F7.3,70A)')TIME, (BLANK, L-l, NSTAR-1), 

♦  STAR , ( BLANK ,  L- 1 , NPLUS-NSTAR- 1 ) , PLUS 

IF(DIARY)  VRITE(4,'("  "  , F7 . 3 , 70A) ' )TIME, (BLANK, L-l ,NSTAR-1) , 
+  STAR , (BLANK , L- 1 , NPLUS-NSTAR- 1 ) , PLUS 
END  IF 
ELSE 

C  CASE  IV  (0  -  XMIN  -  XMAX) 

VRITE(*,'("  ' ' , F7 . 3, 70A) ' )TIME, (BLANK, L=1 , 35) , STAR 
IF(DIARY)  VRITE(4,'("  "  , F7 . 3 , 70A) ' )TIME, (BLANK, L-l , 35) , STAR 
END  IF 
END  IF 

IF  (XMAX(I).LT.O.O)  THEN 

IF  (XMIN(I).EQ.XMAX(I))  THEN 

C  CASE  VIII  (XMIN  -  XMAX  <  0) 

VRITE(* , ' (  "  "  ,F7.3,70A)')TIME,(BLANK,L-1,10), 

♦STAR, (BLANK, L-l , 25) , PLUS 

IF(DIARY)  VRITE(4,'("  "  , F7 . 3 , 70A) ' )TIME, (BLANK, L-l , 10) , 
♦STAR, (BLANK, L-l, 25), PLUS 
ELSE 

C  CASE  V  (XMIN  <  XMAX  <  0) 

NSTAR  -  NINT(69.0*(XHISTR(I,KT)-XMIN(I))/(0.0- 

♦  XMIN(I))M 

NPLUS  -  70 

C  +  it  +  +  +  1tit  +  itirkit1t4tit4riHrir 

VRITE(*. '("  ' ' , F7 . 3 , 70A) ' )TIME, (BLANK, L=1 , NSTAR- 1 ) , 
♦STAR , ( BLANK , L- 1 , NPLUS-NSTAR - 1 ), PLUS 
IF(DIARY)  VRITE(4,'("  "  , F7 . 3, 70A) ' )TIME, 

* ( 8 LANK , L- 1 , NSTAR- 1 ) , STAR , ( BLANK , L- 1 , NPLUS-NSTAR- 1 ) , PLUS 
END  IF 


END  IF 

60  CONTINUE 

IF(DIARY)  THEN 

WRITE(4, 70)  I,XMIN(I) 

WRITE(4,80)  I,XMAX(I) 

WRITE(4, *)  '  ' 

VRITE(4,*)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4,*)  'DO  YOU  VANT  TO  PLOT  ANOTHER  ELEMENT  OF  THE' 
WRITE(4, *)  'STATE  VECTOR  X?' 

END  IF 

WRITE(*,70)  I,XMIN(I) 

70  F0RMAT(1X, 'XMIN( ' ,12, ' )=' ,E12.5) 

VRITE(*,80)  I,XMAX(I) 

80  F0RMAT(1X, 'XMAX( ' ,12, ' ).' ,E12.5) 

C  END  OF  THE  PLOTTING  SUBROUTINE 
WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

WRITE (*,*)  'DO  YOU  WANT  TO  PLOT  ANOTHER  ELEMENT  OF  THE' 

WRITE (*,*)  'STATE  VECTOR  X?' 

CALL  YESORN( ANSWER, DIARY) 

IF  (ANSWER)  GO  TO  30 
IF (DIARY)  THEN 
WRITE(4, *) '  ' 

WRITE (4,*)'  ' 

WRITE(4,*) '  ' 

END  IF 

WRITE(* , *)  '  ' 

WRITE(*, *) '  ' 

WRITE(* , *)  '  ' 

RETURN 

END 

SUBROUTINE  PNRDEF ( PACK , P , R , NMAXPA , NMAXP , NMAXR , N , M , EFFECO , DIARY ) 

C  I 

C  DEFINES  MATRICES  P  AND  R  FROM  PACH  | 

★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★★  ★*★★★*★**  | 

REAL  P ACH ( NMAXPA, N) , P ( NMAXP ,N) , R( NMAXR, N) , TEST ( 15) 

LOGICAL  DIARY 
C 

C  TESTING  IF  PACH(X,J)  IS  COMPLEX 
C 

DO  10  J  -  1,  N 
TEST ( J )  -  0.0 
10  CONTINUE 

DO  20  J  .  1,  N 
DO  20  I  «  1,  N 

TEST(J)  =  TEST(J)  +  ABS(PACH(I+N, J)) 

20  CONTINUE 
C 

C  DEFINING  P 
C 

DO  70  J  *  1 ,  N 
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30 


40 


50 


IF  (TEST(J)  .GE.  0.0)  THEN 
DO  30  I  -  1,  N 

P<I,J)  *  PACH(I,J) 
CONTINUE 
DO  40  I  -  1,  M 
II  *  I+N+N 


R(I,J)  « 
CONTINUE 
ELSE 

JJ  -  J-l 
DO  50  I  -  1, 
P(I,J)  - 
CONTINUE 
DO  60  I  -  1, 


PACH(II, J) 


N 

PACH(I+N, JJ) 


M 


R(I, J)  =  PACH ( I +N+N+M , J J ) 

60  CONTINUE 

END  IF 

IF  (TEST(J)  .GT.  EFFECO)  TEST(J+1)  *  -TEST(J+1) 

70  CONTINUE 

IF( DIARY)  THEN 
WRITE(4,*)'  ' 

VRITE(4, *) ’  ' 

WRITE(4,*) '  ' 

END  IF 

WRITE(*,*)'  ' 

WRITE(*, *) '  ' 

WRITE(*,*)'  ' 

RETURN 

END 

C********************************************************************** | 

SUBROUTINE  POLZER( A ,  B ,  N ,  M , DIARY) 

FINDS  THE  POLES  AND  ZEROES  IN  THE  FREQUENCY  DOMAIN  FOR  THE 
MATRIX  A  FROM  THE  TIME  DOMAIN.  THIS  WILL  PRINT  THE  RESULTS. 

USES  SUBROUTINE  RESOLV  TO  FIND  THE  RESOLVENT  MATRIX,  AND 
SUBROUTINE  PROOT  TO  FIND  THE  ROOTS  OF  THE  POLYNOMIALS  FOUND 
BY  RESOLV. 

C ********************************************************************** 

REAL  A( 15, 15) , Q( 15, 15, 15) , POLES( 16),Z(16),V(I5),U(15),B(I5,15), 
+NUM(15, 15, 15) 

LOGICAL  CHECK, DIARY 
IF(DIARY)  THEN 

WRITE(4, *)  'DO  YOU  WANT  TO  CHECK  THE  RESOLVENT  MATRIX' 

WRITE (4,*)  '  ALGORITHM  ACCURACY?' 

END  IF 

WRITE(*,*)  'DO  YOU  WANT  TO  CHECK  THE  RESOLVENT  MATRIX' 

WRITE(*, *)  '  ALGORITHM  ACCURACY?' 

CALL  YESORN(CHECK, DIARY) 

CALL  RESOLV ( A , POLES , Q , N , CHECK , DI ARY ) 

P0LES(N+1)  -  1.0 
TEST  »  0.0 
NTEST  -  N 

DO  10  K  -  N+l ,  1,  -1 
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IF  (POLES(K)  .EQ.  0.0  .AND.  TEST  .EQ.  0.0)  NTEST  =  1-2 
IF  (POLES(K)  .NE.  0.0)  TEST  -  1.0 
CONTINUE 
IF(DIARY)  THEN 
WRITE(4, *) '  ' 

WRITE(4, *) '  ' 

WRITE (4,*) 'WHEN  PRINTING  THE  COEFFICIENTS  OF  A  POLYNOMIAL' 
WRITE ( 4, *) 'GIVEN  AS:' 

WRITE(4,*)'  ' 

WRITE( 4 , * ) ' A( 1 ) X**N  +  A(2)X**(N-1)  +  ...  +  A(N)X  +  A(N+1)' 
WRITE(4,*)'  ' 

WRITE(4, *) 'THE  FIRST  ELEMENT  IS  A(l),  THE  SECOND  ELEMENT' 
WRITE(4,*) ' IS  A(2),  AND  SO  ON.' 

WRITE(4,*)'  ' 

WRITE(4, *) '  ' 

WRITE(4,*) 'THE  COEFFICIENTS  OF  THE  CHARACTERISTIC  EQUATION:' 
WRITE(4, *) '  ' 

END  IF 

WRITE(*,*)'  ' 

WRITE(*,*)'  ' 

WRITE (*,*) 'WHEN  PRINTING  THE  COEFFICIENTS  OF  A  POLYNOMIAL' 
WRITE (*,*)' GIVEN  AS:’ 

WRITE(*, *) '  ' 

WRITE(*,*)'A(1)X**N  +  A(2)X**(N-1)  +  ...  +  A(N)X  +  A(N+1)' 
WRITE(*,*) '  ' 

WRITE(*, *) 'THE  FIRST  ELEMENT  IS  A(l),  THE  SECOND  ELEMENT' 
WRITE(*, *) ' IS  A(2) ,  AND  SO  ON.' 

WRITE ( * , *) '  ' 

WRITE(*,*)'  ' 

WRITE ( * , * ) ' THE  COEFFICIENTS  OF  THE  CHARACTERISTIC  EQUATION:' 
WRITE(*f  *) '  ' 

DO  20  I  *  NTEST+1 ,  1,  -1 
WRITE(* , *)  POLES(I) 

IF(DIARY)  WRITE(4 , *)  POLES(I) 

CONTINUE 
IF(DIARY)  THEN 
WRITE(4 , *) '  ' 

WRITE(4,*)'  ' 

WRITE(4,*)'THE  POLES:' 

WRITE(4, *) '  ' 

END  IF 

WRITE (*, *) '  ' 

WRITE(*,*)'  ' 

CALL  PROOT (NTEST, POLES, U,V,1) 

WRITE(*,*)'THE  POLES:' 

WRITE(*,*) '  ' 

DO  30  I  -  1,  NTEST 

WRITER, *)U(I),'  +  ',V(I),'i' 

IF(DIARY)  WRITE(4 , *)U( I ) ,'+',V(I),'i' 

CONTINUE 
DO  35  I  -  1,  N 
DO  35  J  *  1,  M 

DO  35  K  «  1,  N 

NUM(I,J,K)  -  0.0 
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35  CONTINUE 

DO  36  I  -  1,  N 
DO  36  J  -  1,  M 

DO  36  JJ  -  1,  N 
DO  36  K  -  1,  N 

NUM(I,J,K)  =  NUM(I , J,K)  +  Q(I,JJ,K)  *  B(JJ,J) 

36  CONTINUE 
IF(DIARY)  THEN 

VRITE(4,*) '  ' 

URITE(4 ,*) '  ' 

WRITE(4,*) 'THE  POLYNOMIALS  IN  {ADJ(SI-A)}B  ARE  GIVEN  AS:' 
END  IF 

WRITE(*,*)'  ' 

VRITE(*,*)'  ' 

VRITE(*,*)'THE  POLYNOMIALS  IN  {ADJ(SI-A)}B  ARE  GIVEN  AS:' 

DO  80  I  -  1,  N 
DO  80  J  *  lf  M 
DO  40  K  =  1,  N 

Z(K)  =  NUM(I, J,K) 

40  CONTINUE 

TEST  *  0.0 

NTEST  -  N-l 

DO  50  K  »  N,  1,  -1 

IF  (Z(K)  .EQ.  0.0  .AND.  TEST  .EQ.  0.0)  NTEST  =  K-2 
IF  (Z(K)  .NE.  0.0)  TEST  *  1.0 
50  CONTINUE 

VRITE(*,*)'  ' 

WRITE (* ,  *) '  ' 

VRITE(*,55)  I,J 
IF(DIARY)  THEN 
VRITE(4,*)'  ' 

VRITE(4 , *) '  ' 

WRITE(4,55)  I,J 
END  IF 

55  FORMAT( IX, 'POLYNOMIAL  IN  POSITION( ’ , 12 , ’ , ' , 12 , ' ) ' ) 

IF  (NTEST  .LT.  0)  THEN 
WRITE(*, *)  '0.0' 

IF(DIARY)  VRITE(4, *)  '0.0' 

END  IF 

DO  60  K  «  NTEST+1 ,  1,  -1 

VRITE(*,*)  Z(K) 

IF(DIARY)  WRITE(4,*)  Z(K) 

60  CONTINUE 

65  WRITE(* , *) '  ' 

WRITE(*, * ) 'THE  ZEROES:' 

WRITE(*,*)'  ' 

IF(DIARY)  THEN 
VRITE(4 , *) '  ' 

VRITE(4, *) 'THE  ZEROES:' 

WRITE(4 , *) '  ' 

END  IF 

IF  (NTEST  .LT.  0)  GO  TO  80 
CALL  PROOT(NTEST, Z, U, V, 1 ) 

DO  70  K  -  1,  NTEST 
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VRITE<*,*)  U(K),'+',V(K),'i' 

IF(DIARY)  VRITE(4, *)  U(K) , ' +' , V(K) , ' i ' 

70  CONTINUE 

80  CONTINUE 

IF(DIARY)  THEN 
VRITE<4,*)  '  ' 

VRITE(4,*)  '  ' 

VRITE(4,*)  '  ' 

END  IF 

VRITE(*,*)  '  ' 

VRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

RETURN 

END 

Q* •k'kit'k'k+rk'kirk'kirk'k'k-kif'k'k'k'k'k'klrk'kie'k'k'k'kirk'k’k'k'k'k'k irk’kitirkirkirk'kit'kirk'klc'kick J 

SUBROUTINE  PRINTA ( NMAX , N , M , A , DIARY ) 

C  I 

C  THIS  SUBROUTINE  PRINTS  OUT  AN  ARBITRARY  MATRIX  A(N,M)  | 

C************************ ★★*★★*★***★★★*★*★★*★*★★*★* ******************* j 
REAL  A(NMAX,M) 

LOGICAL  DIARY 
IF(DIARY)  THEN 
WRITE(4, *)  '  ' 

VRITE(4,*)  '  ' 

END  IF 

WRITE(* , *)  '  ' 

WRITE**,*)  '  ' 

DO  20  I-1,N 

WRITE** , 10)  (A(I, J) , J*1,M) 

WRITE**,*)  '  ' 

IF(DIARY)  THEN 

VRITE(4, 10)  (A(I, J) , J*1,M) 

WRITE(4,*)  '  ' 

END  IF 

10  FORMAT(5E14.5) 

20  CONTINUE 

IF(DIARY)  THEN 
WRITE(4, *) '  ' 

WRITE(4,*) '  ' 

WRITE*4,*)'  ' 

END  IF 

WRITE** ,*) '  ' 

WRITE**, *) '  ' 

WRITE**,*)'  ' 

RETURN 

END 

C** ★★**★** ★★★**★★****★***★**★★*★★*★★***★*★*****★***********★***★ ******* | 

SUBROUTINE  PRINTZ(Z, WR,WI, NMAX, N, DIARY) 

C  I 

C  PRINTS  THE  EIGENSTRUCTURE  AS  DEFINED  BY  Z,  VI,  AND  VR  | 

REAL  Z(NMAX,N) , WR(NMAX) ,VI(NMAX) 

LOGICAL  DIARY 
TEST  -  0.0 


IF( DIARY)  THEN 
VRITE(4,*)  '  ' 

VRITE(4, *)  '  ' 

END  IF 

VRITE(*,*)  '  ' 

WRITE(*,*)  '  ' 

DO  10  J  -  1,  N 

TEST  *  TEST  +  ABS(VI(J)) 

10  CONTINUE 

IF(TEST  .EQ.  0.0)  THEN 

VRITE(*,*)  'THE  VECTOR  OF  EIGENVALUES  IS' 

IF(DIARY)  VRITE(4, *)  'THE  VECTOR  OF  EIGENVALUES  IS' 

CALL  PRNVEC ( WR , NMAX , N , DIARY ) 

I F( DIARY)  THEN 
VRITE(4, *) '  ' 

VRITE(4, *) '  ' 

WRITE (4,*)  'THE  MATRIX  OF  EIGENVECTORS  IS' 

END  IF 

VRITE(*,*)'  ' 

VRJTE(*,*)'  ' 

VRITE(*,*)  'THE  MATRIX  OF  EIGENVECTORS  IS' 

CALL  PRINTA(NMAX,N,N,Z, DIARY) 

IF(DIARY)  THEN 

WRITE(4, *)  'THE  J-TH  COLUMN  OF  THIS  MATRIX' 

WRITE(4,*)  'CORRESPONDS  TO  THE  J-TH  EIGENVALUE' 

END  IF 

VRITE(*, *)  'THE  J-TH  COLUMN  OF  THIS  MATRIX' 

VRITE<*,*)  'CORRESPONDS  TO  THE  J-TH  EIGENVALUE' 

ELSE 

CONJ  -  1.0 
DO  50  J  -  1,  N 

IF(VI(J)  .EQ.  0.0)  THEN 
IF(DIARY)  THEN 
VRITE(4,*)'  ' 

VRITE(4, *) '  ' 

WRITE(4, 15)  J 
URITE(4, 16)  VR( J) 

WRITE(4,*) '  ' 

VRITE(4 , *)  'AND  THE  CORRESPONDING  EIGENVECTOR  IS 
WRITE(4,*)'  ' 

END  IF 

WRITE(*,*)'  ' 

WRITE(*, * ) '  ' 

VRITE(* , 15)  J 

15  FORMAT( IX, 'EIGENVALUE  NUMBER  ',12) 

WRITE(*, 16)  VR(J) 

16  FORMAT( IX, 'IS  ' ,F15.8) 

VRITE(*, *) '  ' 

VRITE(*,*)  'AND  THE  CORRESPONDING  EIGENVECTOR  IS' 
VRITE(*, *) '  ' 

DO  20  I  -  1,  N 

VRITE( * , *)  Z(I,J) 

IF(DIARY)  WRITE(4 , *)  Z(I,J) 

20  CONTINUE 


ELSE 

IF( DIARY)  THEN 
WRITE(4,*)'  ' 

WRITE(4, *) '  ' 

WRITE(4,25)  J 

WRITE(4, *)  'IS' , WR(J) , '  +' , WI(J) , ' i ' 
WRITE(4,*)'  ' 

WRITE(4,*)  'THE  CORRESPONDING  EIGENVECTOR  IS' 
WRITE(4, *) '  ' 

END  IF 

WRITE(*,*) '  ' 

WRITE(*,*)'  ' 

WRITE(*, 25)  J 

25  FORMAT( IX, 'EIGENVALUE  NUMBER  ',12) 

WRITE(*,*)  ' IS' , WR(J) , '  +',WI(J),'i' 

WRITE(*,*)'  ' 

WRITE(*,*)  'THE  CORRESPONDING  EIGENVECTOR  IS' 
WRITE(*, *) '  ' 

IF(CONJ  .GT.  O.O)  THEN 
DO  30  I  -  1,  N 

WRITE(*,*)  Z(I,J),'+' ,Z(I, J+l) , ' i' 

IF (DIARY)  WRITE (4,*)  Z(I , J) , ' +' ,Z(I , J+l) , ' i ' 

30  CONTINUE 

CONJ  =  -1 . *CONJ 
ELSE 

CONJ  -  -1 . *CONJ 
DO  40  I  -  1,  N 

ZI  -  -l.*Z(I,J) 

WRITE(*,*)  Z(I , J-l) , ' +' , ZI , ' i ' 

IF(DIARY)  VRITE(4, *)  Z(I , J-l) , ' +' , ZI , ' i ' 

40  CONTINUE 

END  IF 
END  IF 

50  CONTINUE 
END  IF 

IF( DIARY)  THEN 
WRITE(4,*)'  ' 

WRITE(4,*) '  ' 

WRITE(4,*)'  ' 

END  IF 

WRITE(*, *) '  ' 

WRITE (*,*) '  ' 

WRITE(*, *) '  ' 

RETURN 

END 


SUBROUTINE  PRNVEC(S,NMAX,N, DIARY) 

C  I 

C  PRINTS  AN  ARBITRARY  VECTOR  S  | 


REAL  S(NMAX) 

LOGICAL  DIARY 
DO  10  1*1, N 

WRITE(*,*)  S(I) 
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IF(DIARY)  WRITE(4,*)  S(I) 

10  CONTINUE 
RETURN 
END 

C***************,Mr****************************************^**^^^ 

SUBROUTINE  PROOT(N,A, U, V,IR) 

C 

C  FINDS  THE  ROOTS  OF  A  POLYNOMIAL  WITH  REAL  COEFFICIENTS. 

C  USES  A  MODIFIED  BAIRSTOV  METHOD.  ROUTINE  FOUND  IN  "COMPUTER 

C  PROGRAMS  FOR  COMPUTATIONAL  ASSISTANCE  IN  THE  STUDY  OF  LINEAR 
C  CONTROL  THEORY"  BY  MELSA  AND  JONES,  MCGRAW-HILL  BOOK  COMPANY, 

C  SECOND  EDITION,  1973,  PP  161-163. 

C 

C  N  *  DEGREE  OF  POLYNOMIAL,  N  <  OR  =  15. 

C  A  =  POLYNOMIAL  COEFFICIENT  ARRAY. 

C  U  *  REAL  ROOT  ARRAY.  V  =  IMAGINARY  ROOT  ARRAY. 

C  IR  -  +1  IF  POLYNOMIAL  IS  WRITTEN  AS: 

C  A(l)  +  A(2)S  +  ...  +  A(N+1)S**N 

C  IR  -  -1  IF  POLYNOMIAL  IS  WRITTEN  AS: 

C  A(1)S**N  +  A(2)S**(N-1)  ♦  ...  +  A(N+1) . 

C***************************************************************^^*^ 
DIMENSION  A(16),U(16),V(16),H(17),B(17),C(17) 

IREV  *  IR 
NC  =  N  +  1 
DO  10  I  -  1,  NC 


10 

H(I) 

=  A(  I ) 

P 

-  0. 

Q 

-  0. 

R 

■  0 . 

20 

IF 

v  H  ( 1 ) ) 

i  50,30,50 

30 

NC 

-  NC 

-  1 

V(NC)  . 

0. 

U(NC)  . 

0. 

DO 

40  I 

-  1,  NC 

40 

H(I) 

-  H(I+1) 

GO  TO  20 

50  IF(NC-l)  60,480,60 
60  IF(NC-2)  80,70,80 
70  R.  -H(l)/H(2) 

GO  TO  320 

80  IF(NC-3)  100,90,100 
90  P  -  H(2)/H(3) 

Q  -  H(l)/H(3) 

GO  TO  370 

100  IF(ABS(H(NC-1)/H(NC))-ABS(H(2)/H(1)))  110,170,170 
110  IREV  -  -IREV 
M  -  NC/2 
DO  120  I  -  1,  M 
NL  .  NC  ♦  1  -  I 
F  «  H(NL) 

H(NL)  -  H(I) 

120  H( I )  «  F 

IF(Q)  140,130,140 
130  P  «  0. 


. 


5 

*  v> 


i  * 


B 


140 


GO  TO  150 
P  -  P/Q 
Q  -  l./Q 

150  IF(R)  160,170,160 
160  R  -  l./R 
170  E  -  5.E-10 
B(NC)  -  H(NC) 

C(NC)  -  H(NC) 

B(NC+1)  »  0. 

C(NC+1)  =  0. 

NP  =  NC-1 

180  DO  310  J  *  1,  1000 
DO  190  II  =  1,  NP 

I  *  NC  -  II 

B(I)  «  H(I)  +  R  *  B(I+1) 

C(I)  -  B(I)  +  R  *  C(I+1) 
IF(ABS(B(1)/H(1))-E)  320,320,200 
IF(C(2) )  220,210,220 
R  -  R  +  1. 

GO  TO  230 
R  -  R  -  B(l)/C(2) 

DO  240  II  *  1,  NP 

I  -  NC  -  II 

B(I)  -  H(I)  -  P  *  B(I+1)  - 
C(I)  .  B( I )  -  P  *  c(I+l)  - 
IF(H(2) )  260,250,260 
IF(ABS(B(2)/H(1))-E)  270,270,280 
IF(ABS(B(2)/H(2))-E)  270,270,280 
IF(ABS(B(1)/H(1))-E)  370,370,280 
CBAR  -  C(2)  -  B(2) 

D  -  C(3)**2  -  CBAR*C(4) 

IF(D)  300,290,300 
P  -  P  -  2. 

Q  *  Q  *  (Q  +  1.) 

GO  TO  310 

(B(2)  *  C(3)  -  B(l)  *  C(4) )  /  D 
(~B(2)  *  CBAR  +  B ( 1 )  *  C(3))  /  D 


190 

200 

210 

220 

230 


240 

250 

260 

270 

280 


290 


300 


Q  *  B(I+2) 
0  *  C(I+2) 


P  *  P 
Q  *  Q 
310  CONTINUE 
E  -  E  *  10. 

GO  TO  180 
320  NC  -  NC  -  1 
V(NC)  -  0. 

IF(IREV)  330,340,340 
330  U(NC)  -l./R 


V 

V 

340 

uo  IV  JJU 

U(NC)  -  R 

V 

350 

DO  360  I  *  1,  NC 

i 

360 

H(I)  *  B(I+1 ) 

GO  TO  50 

.N 

370 

NC  -  NC  -  2 

,V 

IF(IREV)  380,390,390 

* 

»s 

380 

QP  -  1.  /  Q 

PP  -  P/(Q  *  2.0) 

1 

'  / 

v  •' 

V 

V 
c 

fct 

GO  TO  400 
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fm 


I  If 


* 


Sf 

u 

7> 


390  QP  =  Q 

PP  -  P  /  2.0 
400  F  -  (PP)**2  -  QP 
IF(F)  410,420,420 
410  U(NC+1)  =  -PP 
U(NC)  =  -PP 
V(NC+1 )  =  SQRT(-F) 

V(NC)  »  -V(NC+1) 

GO  TO  460 

420  IF(PP)  440,430,440 
430  U(NC+1)  =  -SQRT(F) 

GO  TO  450 

440  U(NC+1)  =  -(PP/ABS(PP) )  *  (ABS(PP)  +  SQRT(F) ) 

450  CONTINUE 

V(NC+1 )  »  0. 

U(NC)  *  QP  /  U(NC+1) 

V(NC)  «  0. 

460  DO  470  1=1,  NC 
470  H(I )  -  B(I+2) 

GO  TO  50 
480  RETURN 
END 

C********************************  ★***★*****★*★★  *********  ***■**★•*■**•*  ****■»< 
SUBROUTINE  RESOLV(AR , POLESR , QR , N , CHECK .DIARY ) 

C 

C  A  DOUBLE  PRECISION  ROUTINE  TO  CALCULATE  THE  RESOLVENT  MATRIX 


C  AR  IS  THE  SINGLE  PRECISION  MATRIX  OF  INTEREST. 

C  POLESR  IS  THE  SINGLE  PRECISION  VECTOR  OF  THE  COEFFICIENTS  OF  THE 
C  CHARACTERISTIC  EQUATION. 

C  QR  IS  THE  SINGLE  PRECISION  MATRIX  OF  POLYNOMIALS. 

C  N  IS  THE  ROW  OR  COLUMN  DIMENSION  OF  THE  N  BY  N  A  MATRIX. 

C  CHECK  IS  A  LOGICAL  VARIBLE:  CHECK  -  .TRUE.  -  PRINT  CHECK  OF 

C  ALGORITHM 

C  CHECK  -  .FALSE.  -  NO  PRINT  OF  CHECK 

DOUBLE  PRECISION  A< 15, 15) ,Q( 15, 15, 15) , POLES( 15) . 

+Q1 (15, 15), Q2 (15, 15), TRACE, AIDENT( 15,15) 

REAL  AR(15,N),TEST(15, 15) ,QR( 15, 15, 15) , POLESR ( 15) 

LOGICAL  CHECK, DIARY 
N1  -  N-l 
DO  10  I  -  1,  N 
DO  10  J  «  1,  N 

AIDENT(I,J)  -  O.DO 
A( I , J)  -  DBLE( AR( I , J ) ) 

10  CONTINUE 

DO  20  I  -  1,  N 

AIDENT(I.I)  -  1 . DO 
20  CONTINUE 

DO  30  I  -  1,  N 
DO  30  J  -  1,  N 

Q(I,J,N)  -  AIDENT( I , J ) 

30  CONTINUE 

DO  40  I  •  1,  N 


«ar..*  l.’. 


Ql(I.J)  -  Q(I,J,N) 

40  CONTINUE 

CALL  DAXBEC(Q1,15,N,N,A,15,N,N,Q2,15,DIARY) 

TRACE  -  O.DO 
DO  50  I  «  1,  N 

TRACE  -  TRACE  *  Q2(I,I) 

50  CONTINUE 

POLES(N)  »  -TRACE 
DIV  .  1 . DO 
DO  90  R  .  Nl,  1,  -1 
DIV  -  DIV  ♦  1 .DO 
TRACE  -  O.DO 
DO  60  I  -  1,  N 

AIDENT( I ,  I)  «  P0LES(K+1 ) 

60  CONTINUE 

DO  70  I  -  1,  N 
DO  70  J  -  1,  N 

Q(  I , J ,K)  »  Q2( I , J )  ♦  AIDENT(I,J) 

Q1(I, J)  «  Q(I , J,K) 

70  CONTINUE 

CALL  DAXBEC(Ql ,15,N,N,A,15,N,N,Q2, 15, DIARY) 

DO  80  I  -  1,  N 

TRACE  -  TRACE  +  Q2(I,I) 

80  CONTINUE 

POLES(K)  -  -TRACE/DIV 
<50  CONTINUE 

IF  (CHECK)  THEN 
DO  100  I  -  1,  N 

AIDENT(I.I)  -  POLES(l) 

100  CONTINUE 

DO  no  I  -  1,  N 
Li  110  J  -  1,  N 

TEST(I,J)  -  REAL(Q2(I , J)  +  AIDENT(I,J)) 

110  CONTINUE 

IF(DIARY)  THEN 
VRITE( 4 , * ) ' AS  A  CHECK,' 

VRITE(4, *) 'THE  FOLLOWING  MATRIX  SHOULD  BE  ALL  ZEROES' 
END  IF 

VRITE(*,*)'AS  A  CHECK, ' 

WRITE(* , *) 'THE  FOLLOWING  MATRIX  SHOULD  BE  ALL  ZEROES’ 
CALL  PRINTA(15,N,N, TEST, DIARY) 

END  IF 

DO  130  K  -  N,  1,  -1 
DO  120  I  *  1,  N 
DO  120  J  -  1,  N 

QR(I , J,K)  *  REAL(Q(I , J ,K) ) 

120  CONTINUE 

POLESR(K)  *  REAL(POLES(K) ) 

130  CONTINUE 
RETURN 
END 
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C*******************************'*****'**'*******************************  j 
SUBROUTINE  SAVE(A,B,C,N,M, DIARY, FILED, ITEST) 

C  I 

C  SAVES  A  MATRIX  ON  A  COMPUTER  STORAGE  DEVICE  | 

C********************* *★**★★★★★★★* ★★★*★**★★★***★*★*★*★*★******★★★*****  j 
REAL  A(15,M) ,B(30,M) ,C(30) 

CHARACTER  FILEO*14, FILED*14,TEST*1 
LOGICAL  OLD, DIARY 
WRITE(*,*)'  ' 

VRITE(*,*)'  ' 

WRITE(* ,*) ' WHAT  IS  THE  OUTPUT  FILE  NAME?' 

IF( DIARY)  THEN 
VRITE(4,*)'  ' 

VRITE(4,*)'  ' 

VRITE(4,*)'VHAT  IS  THE  OUTPUT  FILE  NAME?' 

WRITE(*,*)'  ' 

VRITE(*,*)'  ' 

END  IF 

READ(*, ’ (A) ' )  FILEO 
IF (DIARY)  THEN 

VRITE(4,*)  FILEO 
VRITE(4,*) '  ' 

VRITE(4,*)'  ' 

END  IF 

VRITE(*,*)'  ' 

WRITE(*,*) '  ' 

20  VRITE(*,30) 

IF(DIARY)  VRITE(4, 30) 

30  FORMAT ( '  IS  OUTPUT  FILE  NEW  OR  OLD?  ',//,'  REPLY  WITH:  ',//, 

+'  N  FOR  NEV  ',/,'  0  FOR  OLD  ',/) 

READ(*, ' (Al) ' )  TEST 

IF(DIARY)  WRITE(4, *)  TEST 

OLD  -  LLE(TEST,'0')  .AND.  LGE(TEST, '0' ) 

IF  (OLD)  GO  TO  40 

IF(LLT(TEST, 'N' )  .OR.  LGT(TEST, 'N' ))  GO  TO  20 
IF(DIARY)  CL0SE(4) 

OPEN  ( 4, FILE-FILEO, STATUS- 'NEW' ) 

GO  TO  50 

40  IF(DIARY)  CL0SE(4) 

OPEN  (4, FILE-FILEO, STATUS-' UNKNOWN') 

50  CONTINUE 

DO  60  I  -  1,  N 

I F( ITEST  .EQ.  1)  WRITE(4,*)  (A(I , J) , J-l , M) 

IF (ITEST  .EQ.  2)  WRITE(4,*)  (B(I,J),J-1,M) 

I F( ITEST  .EQ.  3)  WRITE(4,*)  C(I) 

60  CONTINUE 
CL0SE(4) 

IF( DIARY)  THEN 

0PEN(4, FILE-FILED, STATUS-'NEV' ) 

WRITE(*,*)  '  ' 

WRITER,*)  '  ' 

WRITE(*,*)  '  ' 

END  IF 

WRITE(* , *)  '  ' 


to 


r. 

<V 

* 


r, 

>, 

4“, 

J'. 


* 
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WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

RETURN 

END 

C********************************************************************* | 
SUBROUTINE  SETUPC(A,B,EVALR,EVALI,SETUP,N,M,NX2) 

C  I 

C  SETUPS  THE  WORKING  MATRIX  WHEN  ANY  ONE  EIGENVALUE  IS  IMAGINARY  j 

| 

REAL  A(15,N) ,B(15,M) , SETUPT(30, 60) , LAMBRE(15, 15) , 

+ LAMBIM ( 1 5 , 1 5 ) , SETUP ( 60 , NX2 ) 

DO  20  I  =  1,  N 
DO  10  J  =  1,  N 

LAMBRE(I , J)  -  0.0 
LAMBIM(I, J)  -  0.0 
10  CONTINUE 

LAMBRE(I,I)  *  EVALR 
LAMBIM  (1,1)  -  EVALI 
20  CONTINUE 

DO  30  I  -  1,  N 
DO  30  J  -  1,  N 

SETUPT(I, J)  *  A(I, J)  -  LAMBRE(I.J) 

SETUPT(I, J+N)  «=  LAMBIM(I , J) 

SETUPT(I+N, J)  -  -1 . *LAMBIM( I , J ) 

SETUPT(I+N, J+N)  -  SETUPT ( I , J ) 

30  CONTINUE 

DO  40  I  *  1,  N 
DO  40  J  -  1,  M 

SETUPT ( I, 2*N+J)  -  B(I, J) 

SETUPT ( I , 2*N+M+ J )  -  0.0 
SETUPT (N+I , 2*N+J)  *  0.0 
SETUPT(N+I , 2*N+M+ J )  -  B(I,J) 

40  CONTINUE 

CALL  ATRANS ( 30 , 60 , 2*N , 2* ( N+M ) , SETUPT , SETUP ) 

RETURN 

END 

SUBROUTINE  SIGPL(S,SIGPLS,NMAXS,NMAXSP,N,M,EFFECO) 

C  I 

C  DEFINES  THE  REQUIRED  MATRIX  SIGMA- PLUS  FROM  THE  SINGULAR  VALUES  | 
C***************************************************'***'**'**'***********  j 
REAL  S(NMAXS) , SIGPLS(NMAXSP , N) 

INTEGER  R 
DO  10  I  -  1,  N 

IF(S(I)  .GT.  EFFECO)  R  =  I 
10  CONTINUE 

DO  20  I  -  1,  M 
DO  20  J  -  1,  N 

SIGPLS(I , J)  =  0.0 
20  CONTINUE 

DO  30  I  =  1,  R 

SIGPLS(I,I)  =  l./S(I) 

30  CONTINUE 
RETURN 


oooooooooo 


END 

C********************************************************************* | 

SUBROUTINE  SIMUL8(A,B,N,M,NMAX, DIARY) 

A  AND  B  ARE  THE  MATRICES  FOR  THE  EQUATION  X(DOT)  =  AX  +  BU  i 

FOR  WHICH  WE  WANT  A  PLOT  OF  THE  TIME  HISTORY.  | 

A  IS  DIMENSIONED  N  X  N  B  IS  DIMENSIONED  N  X  M  (M  =  #  INPUTS). | 
NM  IS  THE  ROW  DIMENSION  OF  BOTH  A  AND  B  AS  FOUND  IN  THE  MAIN  j 
PROGRAM.  ASUBT  AND  BSUBT  ARE  THE  MATRICES  GENERATED  FOR  A  j 

DISCRETE  TIME  SIMULATION  FOR  A  GENERAL  MIMO  SYSTEM  AS  FOUND  | 
IN  "LINEAR  SYSTEM  FUNDAMENTALS"  BY  J.  GARY  REID,  PAGE  273.  j 

REAL  A(NMAX,N),B<NMAX,M),ASUBT(15,15),BSUBT(15,15),E(15,15), 

+T , ETEMP( 15 , 15) , XHISTR( 15 , 151 ) , XI ( 15 ) , XII ( 15 ) , USUBT( 15 ) , 

+IDENT(15, 15) 

LOGICAL  ANSWER, DIARY 
1  WRITE(*,*)  '  ' 

WRITE(*, *)  'ENTER  THE  TIME  INCREMENT  FOR' 

WRITE (*,*)  'THE  TIME  DISCRETIZATION.' 

WRITE(*,*)  '  ' 

READ(*, *)  T 
WRITE(*,*)  '  ' 

WRITE(*,*)  'ENTER  THE  FINAL  TIME  FOR  THE  SIMULATION.' 

READ(*,*)  TF 
IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE (4,*)  'ENTER  THE  TIME  INCREMENT  FOR* 

WRITE(4, *)  'THE  TIME  DISCRETIZATION.' 

WRITE(4,*)  '  ' 

WRITE(4, *)  '  USE  A  DECIMAL  POINT  WHEN  ENTERING  THE  INCREMENT.' 
WRITE(4,*)  T 
WRITE(4,*)  '  ' 

WRITE(4, *)  'ENTER  THE  FINAL  TIME  FOR  THE  SIMULATION.' 

WRITE(4,*)  TF 
END  IF 

K  *  NINT(TF/T) 

IF(K  .GT.  150)  THEN 
IF(DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4,*)  'THIS  CHOICE  OF  TIME  INCREMENT  AND  FINAL  TIME' 
WRITE(4,*)  'REQUIRES  TOO  MANY  POINTS.  SELECT  AGAIN  SUCH' 
WRITE(4, *)  'THAT  FINAL  TIME  /  TIME  INCREMENT  <  150' 

END  IF 

WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*, *)  'THIS  CHOICE  OF  TIME  INCREMENT  AND  FINAL  TIME' 
WRITE(*,*)  'REQUIRES  TOO  MANY  POINTS.  SELECT  AGAIN  SUCH' 
WRITE(*,*)  'THAT  FINAL  TIME  /  TIME  INCREMENT  <  150' 

GO  TO  1 
END  IF 
TOL  *  l.E-8 
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DIV  -  2.0 
AF  -  0.0 
DO  5  I  -  1,  M 
IF( DIARY)  THEN 
WRITE(4, *)  '  ' 

WRITE (4, 2)  I 

VRITE(4,*)  'FOR  A  STEP  INPUT  WITH  ZERO  INITIAL  CONDITIONS' 
END  IF 

WRITE(*,*)  '  ' 

WRITE(*,2)  I 

FORMAT ( IX , ' ENTER  THE  VALUE  OF  INPUT  VARIABLE  #  ',12) 
WRITE(*, *)  'FOR  A  STEP  INPUT  WITH  ZERO  INITIAL  CONDITIONS' 
READ(*,*)  USUBT(I) 

IF (DIARY)  VRITE(4,*)  USUBT(I) 

CONTINUE 
DO  10  I  =  1,  N 
XI(I)  »  0.0 
CONTINUE 
DO  15  I  *  1 ,N 
DO  15  J  -  1  ,N 

AF  -  A(I, J)*A(I, J)  +  AF 
CONTINUE 
AF  -  SQRT(AF) 

AF  IS  THE  FROEBINIUS  NORM  OF  THE  MATRIX  A. 

SEE  PAGE  276  OF  "LINEAR  SYSTEM  FUNDAMENTALS" 

NOW  TO  FIND  AN  APPROPRIATE  SQUARING  COEFFICIENT  NN  FOR  THE 
SQUARING  ALGORITHM 

TEST  *  AF*T/2.0 
NN  -  1 

IF(TEST.LT.l.O)  GO  TO  30 
TEST  -  TEST/ 2.0 
NN  «=  NN  +  1 
GO  TO  20 

QUO  -  T/(2.0**NN) 

DEFINING  THE  IDENTITY  MATRIX  AND  FIRST  TERM  OF  THE 
E-SUB-0  POWER  SERIES 

DO  50  I  -  1,N 
DO  40  J  -  1,N 

IDENT(I, J)  -  0.0 
E(I,J)  .  0.0 
CONTINUE 
IDENT(I, I)  *  1.0 
E(I ,1)  -  QUO 
CONTINUE 


DEFINING  THE  SECOND  TERM  OF  POWER  SERIES  -  TO  BE 
SUCCESSIVE  TERM,  AND  ADDS  IT  TO  E-SUB-0 


USED  FOR  EACH 


DO  60  I  -  1,N 
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j*  Vs 


ooooooo  ooo  noon  o  o  n 


DO  60  J  -  1,N 

BSUBT(I , J)  .  A  ( I ,  J  ) *QU0*QU0/ 2 . 0 
60  CONTINUE 
70  DO  80  I  -  lfN 

DO  80  J  -  1,N 

E(I , J)  -  E(I, J)  +  BSUBT(I,J) 

80  CONTINUE 

HERE,  BSUBT  IS  THE  LAST  ELEMENT  OF  THE  POWER  SERIES 
DIV  -  DIV  +1.0 

CALL  AXBEQC( A , NMAX ,N,N, BSUBT , 15 , N , N , ETEMP , 15 , DIARY ) 

HIGH  -  0.0 
DO  90  I  -  1,N 
DO  90  J  -  1,N 

ETEMP(I.J)  -  ETEMP(I, J)*QU0/DIV 
TEST  -  ABS(BSUBT(I, J)  -  ETEMP(I.J)) 

HIGH  -  AMAX1 (TEST, HIGH) 

BSUBT(I , J)  -  ETEMP(I , J) 

90  CONTINUE 

IF(HIGH.GT.TOL)  GO  TO  70 
DO  100  I  «  1,N 
DO  100  J  *  1,N 

E(I, J)  -  E(I , J)  +  BSUBT(I, J) 

100  CONTINUE 

THE  MATRIX  E-SUB-0  IS  NOW  KNOWN  AS  E(I,J). 

NOW  TO  DEFINE  F- SUB-0  (ASUBT(I,J)). 

CALL  AXBEQC(A,NMAX,N,N,E, 15,N,N,ASUBT, 15, DIARY) 

DO  110  I  -  1 ,N 
DO  110  J  -  1 ,N 

ASUBT(I, J)  -  ASUBT ( I , J )  +  IDENT(I,J) 

110  CONTINUE 

CALCULATING  E-SUB-N  (E(I,J))  AND  F-SUB-N 
DO  130  MM  -  1 ,NN 

CALL  AXBEQC( ASUBT ,15,N,N,E,15,N,N, BSUBT , 15 , DIARY) 

DO  120  I  -  1,N 
DO  120  J  *  1,N 

E(I , J)  «  E(I, J)  +  BSUBT(I, J) 

BSUBT(I.J)  -  ASUBT(I , J) 

120  CONTINUE 

CALL  AXBEQC( BSUBT , 15 , N , N , BSUBT , 15 , N , N , ASUBT , 15 , DIARY) 
130  CONTINUE 

THIS  ASUBT  IS  THE  SAME  A-SUB-T  USED  IN  "LINEAR  SYSTEM 
FUNDAMENTALS" 

CALL  AXBEQC(E, 15, N,N,B, NMAX, N,M, BSUBT, 15, DIARY) 

LIKEWISE,  THIS  IS  THE  DESIRED  B-SUB-T. 

NOW  TO  CALCULATE  THE  TIME  HISTORY  OF  X. 


DO  180  KOUNT  -  1,  K+l 

IF  (KOUNT  .EQ.  1)  GO  TO  150 

CALL  AXBEQC ( ASUBT , 1 5 , N , N , XI , 1 5 , N , 1 , XII , 1 5 , DI ARY ) 
CALL  AXBEQC (BSUBT , 15 , N, M , USUBT , 15 , M , 1 , XI , 15 , DIARY) 
DO  140  I  -  1,N 

XI(I)  .  XI(I)  +  XII(I) 

CONTINUE 
DO  170  I  -  1 ,N 

XHISTR(I,KOUNT)  .  XI(I) 

CONTINUE 
CONTINUE 
KP1  *  K  +  1 

CALL  PLOT ( XHI STR , KP 1 , N , T , NMAX , DIARY ) 

IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

WRITE(4, *)  '  ' 


WRITE(4, *)  '  ' 

WRITE(4,*)  'DO  YOU  WANT  TO  RE-DO  THE  TIME  SIMULATION  WITH  OTHER' 
WRITE (4,*)  'TIME  PARAMETERS?' 

END  IF 

WRITE(* ,*)  '  ' 

WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*, *)  'DO  YOU  WANT  TO  RE-DO  THE  TIME  SIMULATION  WITH  OTHER' 
WRITE (*,*)  'TIME  PARAMETERS?' 

CALL  YESORN( ANSWER, DIARY) 

IF( ANSWER)  GO  TO  1 
IF(DIARY)  THEN 
WRITE(4,*)  '  ' 

WRITE(4,*)  '  ' 

WRITE(4, *)  '  ' 

END  IF 

WRITE(*, *)  '  ' 

WRITE(*,*)  '  ' 

WRITE(*, *)  '  ' 

RETURN 

END 

Q*********************************************************** ********** | 

SUBROUTINE  SUBST(U,B,X,IPIVOT,N,NMAX) 

C  I 

C  USED  TO  INVERT  A  MATRIX  WITH  SUBROUTINE  FACTOR  j 

c********* ****************************************************** ****** j 

DIMENSION  W(NMAX,N),B(N),X(N),IPIVOT(N) 

IF  (N  .GT.  1)  GO  TO  10 
X(l)  »  B(l)  /  W( 1 , 1 ) 

RETURN 

10  IP  -  IPIVOT(l) 

X(l)  -  B(IP) 

DO  15  K  -  2,  N 
IP  -  IPIVOT(K) 

KMI  *  K  -  1 
SUM  -  0. 

DO  14  J  -  1,  KMI 


liA"'  \  ^ 


SUM  =  V(IP,J)  *  X(J)  +  SUM 

14  CONTINUE 

X(K)  «  B(IP)  -  SUM 

15  CONTINUE 

X(N)  -  X(N)  /  V(IP,N) 

K  -  N 

DO  20  NPIMK  =  2,  N 
KPI  -  K 
K  »  K  -  1 
IP  -  IPIVOT(K) 

SUM  =  0. 

DO  19  J  =  KPI,  N 

SUM  *  V(IP,J)  *  X<J)  +  SUM 

19  CONTINUE 

X(K)  -  (X(K)  -  SUM)  /  V(IP,K) 

20  CONTINUE 
RETURN 
END 

SUBROUTINE  SVD(A,MMAX,NMAX,M,N,NU,NV, S,U,V,IER) 

C  I 

C  USES  A  MODIFIED  ACM  ROUTINE  CSVD.  | 

Q* | 

REAL  A(MMAX,N),U(MMAX,M),V(NMAX,N),S(N),B(60),C(60),T(60), 

+Q,R 

INTEGER  P 

DATA  ETA,T0L/1 . 5E-8, 1 .E-31/ 

P-0 

NP-N+P 

Nl-N+1 

C 

C  HOUSEHOLDER  REDUCTION 

C(1)-0.E0 
K-l 

10  Kl-K+1 


if. 

>>. 


C 

C 


ELIMINATION  OF  A(I,K),  I-K+l,. 
Z-O.EO 
DO  20  I-K,M 
20  Z«Z+A(I ,K)**2 

B(K)-0.E0 

IF(Z. LE.TOL)GOTO  70 
Z-SQRT(Z) 

B(K)-Z 

y-ABS(A(K,K)) 

Q-l.EO 

IF(V.NE.0.E0)Q-A(K,K)/V 
A(K,K)-Q*(Z+V) 

IF(K.EQ.NP)GOTO 
DO  50  J-Kl.NP 
Q-O.EO 
DO  30  I-K,M 

30  Q-Q+ A( I , K)*A( I , J ) 

Q-Q/ (Z*(Z+U) ) 
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• » M 


70 


.< cX  Os/C.  s‘ 


DO  40  I=K,M 

40  A(I, J)=A(I, J)-Q*A(I,K) 

50  CONTINUE 

C 

C  PHASE  TRANSFORMATION 

Q--A(K, K)/ABS(A(K,K) ) 

DO  60  J-K1,NP 

60  A(K,J)=Q*A<K,J) 

C 

C  ELIMINATION  OF  A(K,J),  J-K+2,...,N 
70  IF(K.EQ.N)GOTO  140 
Z-O.EO 

DO  80  J-Kl ,N 

80  Z-Z+A(K, J)**2 

C(K1)=0.E0 
IF(Z. LE.TOL)GOTO  130 
Z-SQRT(Z) 

C(K1)*Z 

V=ABS(A(K,K1)) 

Q-l.EO 

IF(V.NE.0.E0)Q«A(K,K1)/V 

A(R,K1)-Q*<Z+V) 

DO  110  I-K1.N 
0-0. EO 
DO  90  J-Kl tN 

90  Q«Q+A(R, J)*A(I, J) 

Q-Q/ (Z*(Z+U) ) 

DO  100  J«R1,N 

100  A(I, J)-A(I, J)-Q*A(R, J) 

110  CONTINUE 

C 

C  PHASE  TRANSFORMATION 

0— A(R,R1)/ABS(A(R,R1)) 

DO  120  I-R1,M 
120  A(I,R1)-A(I,R1)*Q 

130  K-Kl 

GOTO  10 
C 

C  TOLERANCE  FOR  NEGLIGIBLE  ELEMENTS 
140  EPS-0. EO 

DO  150  R*1  ,N 
S(R)-B(R) 

T(R)-C(R) 

150  EPS-AMAX1(EPS, S(R)+T(R)) 

EPS-EPS*ETA 
C 

C  INITIALIZATION  OF  U  AND  V 
IF(NU.EQ.O)GOTO  180 
DO  170  J-1,NU 
DO  160  1-1, M 
160  U(I,J)«O.EO 

170  U(J, J)-l . EO 

180  IF(NV.EQ.O)GOTO  210 
DO  200  J-l.NV 
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DO  190  I-1,N 
190  V(I,J)-O.EO 
200  V(J,J)-1.E0 
C 

C  QR  DIAGONALIZATION 
210  DO  380  KK=1,N 
K-N1-KK 


ITS=0 

C 

C  TEST  FOR  SPLIT 
220  DO  230  LL=1,K 
L.fC+1-LL 


230 


IF(ABS(T(L)).LE.EPS)GOTO  290 
IF(ABS(S(L-1)).LE.EPS)G0T0  240 
CONTINUE 


C 

C  CANCELLATION  OF  E(L) 
240  CS-O.EO 
SN-l.EO 


Ll-L-1 


DO  280  IaL,K 
F=SN*T(I) 

T(I)*CS*T(I) 

IF(ABS(F).LE.EPS)GOTO  290 
H-S(I) 

V-SQRT(F*F+H*H) 

S(I)=W 
CS-H/V 
SN— F/W 


IF(NU.EQ.O)GOTO  260 
DO  250  J«1,N 
X-U(J.Ll) 

Y-U(J.I) 

U(J , L1)»X*CS+Y*SN 
250  U( J , I )=Y*CS-X*SN 

260  IF(NP.EQ.N)GOTO  280 

DO  270  J«N1,NP 
Q-A(L1,J) 

R=A(I, J) 

A(L1,J)-Q*CS+R*SN 
270  A(I, J)«R*CS-Q*SN 

280  CONTINUE 


C 

C  TEST  FOR  CONVERGENCE 
290  V-S(K) 

IF(L.EQ.K)GOTO  360 
IF(ITS.EQ. 30)  GOTO  565 
ITS-ITS+1 

C 

C  ORIGIN  SHIFT 
X-S(L) 

Y-S(K-l) 

G-T(K-l) 

H-T(K) 
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F=((Y-V)*(Y+tf)+(G-H)*(G+H))/(2.E0*H*Y) 

G-SQRT(F*F+1.E0) 

IF(F. LT.O. EO)G*-G 

F*( (X-W)*(X+W)+( Y/ (F+G)-H)*H)/X 

C  QR  STEP 

CS=l.EO 

SN-l.EO 

Ll-L+1 

DO  350  I-Ll.K 
G=T(I) 

Y-S(I) 

H-SN*G 

G=»CS*G 

W«SQRT(H*H+F*F) 

T(I-1)=W 

CS-F/W 

SN-H/W 

F»X*CS+G*SN 

G-G*CS-X*SN 

H-Y*SN 

Y-Y*CS 

IF(NV.EQ.O)GOTO  310 
DO  300  J=1 , N 
X=V(J,I-1) 

W-V(J.I) 

V(J,I-1)»X*CS+W*SN 
300  V( J , I ) -V*CS-X*SN 

310  y-SQRT(H*H+F*F) 

S(I-1)-U 
cs*F/w 
SN»H/V 
F»CS*G+SN*Y 
X»CS*Y-SN*G 
IF(NU.EQ.O)GOTO  330 
DO  320  J-1,N 
YaU(J,I-l) 
y«U(J,I) 

U(J ,I-1)»Y*CS+V*SN 
320  U(J,I)-U*CS-Y*SN 

330  IF(N.EQ.NP)GOTO  350 
DO  340  J-Nl.NP 
Q-A(I-l.J) 

R«A(I,J) 

A(I-1, J)-Q*CS*R*SN 
340  A ( I , J ) «R*CS-Q*SN 

350  CONTINUE 

T(L)*O.EO 
T(K)*F 
S(K)-X 
GOTO  220 

CONVERGENCE 

!60  IF(V.GE.O.EO)GOTO  380 


S(K)=-V 

IF(NV.EQ.O)GOTO  380 
DO  370  J=1,N 
70  V(J,K)-V(J,K) 

80  CONTINUE 

SORT  SINGULAR  VALUES 
DO  450  K=1,N 
G=-l . EO 
J=K 

DO  390  I=K,N 

IF(S(I).LE.G)GOTO  390 
G-S(I) 

J-I 

>0  CONTINUE 

IF(J.EQ.K)G0T0  450 
S(J)-S(K) 

S(K)=G 

IF(NV. EQ . 0)G0T0  410 
DO  400  1=1,  N 
Q=V(I, J) 

V(I,J)-V(I,K) 

10  V(I,K)=Q 

0  IF(NU.EQ.0)G0T0  430 
DO  420  1=1, N 
0=0(1, J) 

U(I,J)=U(I,K) 

0  U(I,K)=Q 

0  IF(N.EQ.NP)G0T0  450 

DO  440  I=N1 ,NP 
Q=A(J,I) 

A(J,I)=A(K,I) 

0  A(K,I)=Q 

0  CONTINUE 

BACK  TRANSFORMATION 
IF(NU.EQ.O)GOTO  510 
DO  500  KK=1,N 
K-N1-KK 

IF(B(K).EQ.O.EO)GOTO  500 
Q— A(K,K)/ABS(A(K,K)) 

DO  460  J=1 ,NU 
)  U(K, J)=Q*U(K, J) 

DO  490  J=1,NU 
Q-O.EO 
DO  470  I=K,M 

1  Q-Q+A(I,K)*U(I,J) 

Q-Q/(ABS(A(K,K))*B(K)) 

DO  480  I=K,M 

U(I,J)=U(I,J)-Q*A(I,K) 

CONTINUE 

CONTINUE 

IF(NV. EQ. 0)G0T0  570 
IF(N.LT.2)G0T0  570 


'  *-  ; 


i jCm 

* 


DO  560  KK=2 , N 
K=N1-KK 
K1=K+1 

IF(C(K1).EQ.0.E0)G0T0  560 
Q=-A(K,K1)/ABS(A(K,K1) ) 

DO  520  J=1 ,NV 

520  V(K1 ,  J)s=Q*V(Kl ,  J) 

DO  550  J=1 , NV 
Q=0.E0 

DO  530  I=K1,N 

530  Q=Q+A(K, I)*V(I , J) 

Q=Q/(ABS(A(K,K1))*C(K1)) 

DO  540  I=K1 ,N 

540  V(I, J)=V(I, J)-Q*A(K,I) 

550  CONTINUE 

560  CONTINUE 

GOTO  570 

C  SET  ERROR  -  NO  CONVERGENCE  TO  A  SINGULAR  VALUE 

C  AFTER  30  ITERATIONS 

565  IER=9999 

570  RETURN 
END 

SUBROUTINE  V2DEF(V, NMV,N, S ,NMS,V2 ,NV2 , EFFECO, DIARY) 

C  I 

C  DETERMINES  THE  NULL  SPACE  GIVEN  V  AND  THE  ORDERED  SINGULAR  VALUES  | 

£★***★★★★★*★***★*★★★★★★**★★★★★★★★*★★**★★★★*★*★*★**★★*****★★★★**★*★** ★* | 

REAL  S(NMS) , EFFECO, V(NMV,N) ,V2(NMV,N) 

LOGICAL  DIARY 
DO  10  I  =  1,  N 

IF(S(I)  .GT.  EFFECO)  II  =  I 
10  CONTINUE 

NV2  =.  N  -  II 
IF(NV2  .EQ.  0)  THEN 

WRITE(*,*)  'THE  MATRIX  IS  OF  FULL  RANK' 

IF(DIARY)  WRITE(4, *)  'THE  MATRIX  IS  OF  FULL  RANK' 

ELSE 

DO  20  I  -  1,  N 

DO  20  J  «  1,  NV2 

V2(I , J)  »  V(I,J+II) 

20  CONTINUE 

END  IF 
RETURN 
END 

C************************************** ***************** *************  J 

SUBROUTINE  V2SDEF(V2,V2S,NV2MAX,NV2SMX,N,M) 

C  I 

C  DEFINES  THE  REQUIRED  SUB-MATRIX  V2S  FROM  V2  j 

c* ★★*★★* **************** >. ***************************** ********** ***** | 
REAL  V2(NV2MAX,M) , V2S(NV2SMX, M) 

DO  10  I  *  1 ,  N 
DO  10  J  =  1,  M 


o  o 


RETURN 

END 

C************************************* ******************************* | 

SUBROUTINE  YESORN( ANSWER, DIARY) 

I 

FINDS  THE  ANSWER  TO  THE  QUESTION  ASKED  IN  THE  CALLING  PROGRAM  | 
C* ******************************* ************************************ j 
CHARACTER* 1  TEST 
LOGICAL  ANSWER, DIARY 

10  WRITE(*, *)  '  ENTER  Y  FOR  YES  OR  N  FOR  NO' 

IF(DIARY)  WRITE(4,*)  '  ENTER  Y  FOR  YES  OR  N  FOR  NO' 

READ(*, ' (Al) ' )  TEST 
IF(DIARY)  WRITE(4, *)  TEST 

ANSWER  =  <(LLE(TEST,'Y')  .AND.  LGE(TEST, ' Y' ) )  ,0R. 
+(LLE(TEST,'y')  .AND.  LGECTEST, 'y' ))) 

IF  (ANSWER)  GO  TO  20 

IF((LLT(TEST,'N')  .OR.  LGT(TEST, 'N' ))  .AND. 

+(LLT(TEST, ' n' )  .OR.  LGT(TEST, ' n' ) ) )  GO  TO  10 
20  IF(DIARY)  WRITE(4,*)  '  ' 

WRITE(*, *)  '  ' 

RETURN 

END 
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The  design  engineer  can  specify  the  closed-loop 
response  of  a  system,  including  both  the  modes  and  mode 
shapes,  with  the  eigenstructure  assignment  approach  to 
system  synthesis.  This  effort  was  to  create  an  interactive 
computer-aided  control  system  design  program  to  enable  the 
designer  to  use  the  modern  control  approach  to  design  a 
control  system  with  specified  response  characteristics,  or 
to  come  as  close  to  the  ideal  as  possible.  With  the 
program  MODES,  the  design  engineer  can  easily  calculate  the 
feedback  gains  needed  to  give  the  controlled  system  the 
optimum  response  characteristics  by  specifying  the  desired 

eigenvalues  and  eigenvectors.  The  singular  value  decomposi- 

y 

position  is  used  to  accomplish  this.  4->  .  •> 

In  addition,  MODES  can  provide  valuable  information 
about  the  controlled  system  to  assist  the  designer  in 
specifying  the  desired  eigenstructure.  By  calculating  the 
eigenvalues  and  eigenvectors  of  the  original  system,  by 
plotting  the  time  response  history  of  the  original  system, 
and  by  calculating  the  resolvent  matrix,  poles  and  zeroes 
for  classical  control  analysis,  MODES  is  a  strong  tool  in 
determining  how  the  eigenstructure  should  be  altered.  By 
presenting  the  same  information  for  the  modified  "optimized" 
system,  MODES  can  show  where  additional  changes  to  the 
specified  desired  eigenstructure  should  be  made. 

The  accuracy  of  MODES  is  verified  with  sample  appli¬ 
cations  found  in  the  technical  literature. 


